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INTRODUCTION 


Tlie  oi'Cration  of  n fire  control  syGt.em  entails  several  tasks.  The 
weapon  system  must  acquire  a target,  lock  on  and  maintain  track,  accurately 
estimate  the  present  tarp.et  state,  and  provide  p,un  orders  based  upon  the 
predicted  future  position  oV  the  tar^-a't.  The  tarf'et  state  may  consist  of  any 
ctjnvenient  set  of  variables  used  to  describe  the  dynamics  of  the  tarf'et  motion. 
Typically,  these  are  the  tarp;et  position,  velocity,  and  acceleration,  as  well 
as  auxiliary  variables  wnicii  describe  tiie  stochastic  behavior  of  the  motion. 
Accuracy  in  estiiruition  of  target  .state  is  a necessary  condition  for  predictinp 
its  future  position.  Unfortunately,  it  is  not  a sufficient  condition,  since 
ttic  tarpe  t can  underpo  unexpected  maneuvers  durin;/  the  t ime-of-fllrht  of  the 
pro.iectilo  resuitinp  n a miss.  Tlie  purpose  of  this  report  is  to  focus  on  the 
problem  of  ta't’Ct  state  estimation. 

Modern  state  estimation  tlieory  provides  a powerful  tool  for  esti  matirip,  target 
state  from  sensor  data  of  target  position  and  rate  information,  if  available. 

The  power  of  this  theory,  sometimes  referred  to  as  Kalman  filtering,  derives 
from  the  fact  that  the  estimation  procedure  is  iterative  so  that  only  the 
present  sensor  measurements  and  the  previous  "optimal"  taipet  state  esti.matos 
are  needed  to  com.pute  the  "optimal"  estimate  of  the  present  tarpet  state.  This 
feature  of  the  theory  obviates  tne  need  to  store  a larp;e  number  of  data  points. 
Furthermore,  the  solution  for  the  "optimal"  estimate  is  related  linearly  to. 
the  observations  and  the  previous  optimal  estimate  which  is  an  additional 
simplifying  feature  of  the  theory. 

This  report  describes  several  Kalman  filter  desipns,  from  whicn  a candi- 
date for  possible  implementation  in  a fire  control  system  is  chosen.  Iri  sclectinp 
the  final  filter  desippi,  two  criteria  are  applied.  One  is  that  th^  r.  jmber  of 
state  variables  be  relatively  small  so  as  to  reduce  the  computatj  tajal  time  for 
the  state  estimates.  The  second  is  that  the  relative  accuracy  of  Ibu  state 
estimates  be  high. 

The  lack  at  present  of  a complete  model  for  maneuverin,  tirj.;ets  as  well 
as  insufficient  data  on  sensor  performance  characteristics  gcierally  impr.''.es 
a limit  on  the  accuracy  of  I’ilter  design  and  hence,  its  performance.  Computer 
requirements  impose  an  additional  constraint  in  that  an  accurate  target  model, 
which  may  require  for  its  description  a large  number  of  state  variables,  nay 
result  in  a relatively  long  time  to  solution  for  the  estimates  cf  i.he  state 
variables.  Finally,  the  statistics  governing  real  ai  rcraft  motion  ma,v  liot  , in 
fact,  be  Gaussian  as  required  by  the  theory  to  achieve  global  optimality. 

Although  proposals  for  using  Kalman  f i I ter;-,  in  aii'  defen  i ite  baeV  to  tn<- 
19U0's,  the  filter  design  pre.sentea  here  is  unique  for  two  reasons.  Comp.ared 
to  designs  proposed  heretofore,  the  filter  described  here  is  of  minimal  matb<;- 
matical  complexity.  Gecondly,  flight  data  on  high  performttn-e  aircraft  made 
recently  available,  is  utilized  to  optimize  the  filter  design  through  mod'-l 
identification. 

A brief  description  of  the  available  flight  path  data  ujion  which  the  design 
is  based  as  well  as  the  underlying  assumptions  leading  to  a particular  design 
philosophy  are  discussed  in  the  following  secl.iori. 
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r-KCTION  J 


;;TATKr«NT  of  thk  probiJ’;m 


Imrinp  the  3umjnt.r  of  IOTU  , the  FrfinkfortJ  Arsenal  Capabilities  Test  (■'ACT 
Was  corulucted  at  tiie  Naval  '.Vcaj/ons  Center  at  China  Lake,  California.  Iri  thest 
tests,  tactical  aircraft  were  flown  to  simulate  combat  conditions.  Acceloro- 
meterr.  placed  on  board  the  aircraft  recorded  aircraft  aecel  erati  ons  for  20  flipht 
patiiG  wiiile  a pround  based  Nike  Hercules  radar  recorded  aircraft  position.  K rty 
more  simulated  attack  missicius  were  flown  for  which  only  radar  derived  tarpel 
position  information  was  recorded.  At  the  completion  of  tliese  tests,  it  war. 
recOi’nized  tiiat  tlie  FACT  data  may  provide  the  basis  for  a filter  desipn.  Tbe  I'.iv 
desipn  poals  woiilii  be  accuracy  ?uid  simplicity. 

In  desipninp  a suitable  filter,  one  must  decide  uj>on  i coordinate  system 
in  wnicii  to  filter  sensor  data.  'iTc  most  likely  c.-uidiatcs  arc  rec  tai.fsj  i ar  and 
spherical  coordinates.  ;if)nerical  coordinattss  provide  a nat.ural  set  iri  wiiici.  to 
Operate  the  filter  because  the  sensor  data  is  already  in  spherical  form.  However, 
one  in  faced  with  tiie  problem  of  adequately  modeling  the  tarpet  motion  in  this 
set.  '"he  restrictions  on  tiie  model  of  tarpet  dyn;imicn  arise  from  the  Kalman 
theory  whicli  states  tiiat  tiie  plant  equatiori.s  (a  name  pi  von  to  the  equatio.ns 
describinp  the  tarpet  motion)  must  be  linear  differential  equations  .n  the  s’.ate 
variables.  If  the  problem  involves  non-linear  dynamics,  then  the  Kaltr'ui  tlieory 
is  still  applicable,  provided  that  suitable  linearization  is  possible. 

The  difficulty  in  r.iiitably  modeljiip  tarpet  d vii.ini  i cs  in  sjiherical  cooriinates 
is  illustrated  by  the  I'ollowinp  example.  Cupf«sc  that  X|  is  the  state  variable 
for  the  ranp.e  to  the  tarpet.,  desip, nated  by  H in  spherical  coordinates.  If  one 
moricls  tiie  acceleration  in  x^  as  composeu  of  botii  a riaidom  and  .u  deterministic 
component  X;^  aiid  Xj^ , respectively,  then  a four  state  model  may  look  like 


Xj  = X^) 


= X j + x,^ 


*3  ” 


xi,  = 0 


with  u = wiiite  noise.  Consiiicr,  for  the  sake  of  simplicity,  the  determi  ni  st.i  c 
portion  of  tiie  model,  obtained  uy  settitip  rx  = p = 0.  'Hie  rcsultinp  expressions 
can  then  be  easily  solved  for  Xj^  to  yield  .a  'trd  depree  polynomial  in  time. 
However,  under  almost  all  c ircurostajices , trie  ranpe  R i s an  infinite  serie.t  in 
time.  Ltrictly  speakinp,  then,  one  woiold  require  an  infinite  set  of  state 
variables  to  accurately  describe  the  deterministic  portion  of  the  accr 1 erat i cti 
in  R.  One  may,  nevertheless,  proceed  to  implement  such  a mo<!ei  under  the 
a.ssumption  tiiat  the  state  estimates  will  be  reasonable  anyway. 


9 


rnr- 


Hy  filLeriri).'  in  Uie  r*'iM,nn»nji.ar  set,  thin  problem  is  obviated.  However, 
ditTiculLy  arises  when  tme  attemf't::  to  di-seribe  the  scri.sor  by  a linear  mode] 
(linear  in  the  state  variables)  in  this  s(.-t.  The  source  of  this  difficulty  is 
the  fact  that  the  sensor  data  is  in  spherical  form  whereas  the  state  variables 
are  now  in  describe<l  rect.'uij'ul  ar  coordinates.  Conversion  of  the  sensor  data 
into  the  rectangular  set  is  a non-linear  transormation  which  results  in  equa- 
tions whicii  are  non-linear  rather  than  linear  in  the  state  variables  as  required 
by  the  ttieory.  Tiiis,  iiowever,  is  a minor  firawback  for  two  reasons.  Tlje  first, 
is  that  suitable  linearization  of  the  equations  describinr  the  sensor  model  is 
possible  but  with  the  slipht  jienalty  that  the  coefficients  of  the  state  variables 
become  time  dependent.  The  second  reason  is  that  more  is  r.enerally  known  about 
sensor  error  characteristics  than  about  aircraft  dynamics.  One  therefore,  has 
more  information  available  to  construct  a model  representative  of  a real  sensor 
than  information  about  aircraft  dynanics  to  construct  a single  model  which  ade- 
quately describes  the  spectrum  of  real  aircraft  maneuvers.  For  this  reason, 
emphasis  in  this  report  will  be  placed  on  the  plant  model.  The  sensor  noise 
will  he  modeled  as  a white  noise  sequence,  although  filter  performance  apainst 
sensor  errors  described  by  a first  order  Markov  process  will  also  be  investigated. 

Another  important  consideration  in  choosinp;  a suitable  coordinate  frame  is 
the  description  ol‘  the  stochastic  behavior  of  the  aircral't  acceleration.  If 
the  tarret  acceleration  is  characterized  by  stationary  (laus.sian  statistics,  a 
debateabie  point  at  this  time,  then  Gaussian  stationarity  is  more  likely  to  V)e 
manifest  in  the  inertial  frame  ( rect;uipu 1 ar  f rame ) than  in  a rotating  non-inertial 
polar  f rfjjne . For  the  reasons  mentioned  above,  inertial  (fixed  to  the  earth) 
coordinates  are  chosen  for  modelinp  the  filter. 

After  choosinp  a suitable  coordinate  system,  one  must  adequately  model  both 
the  dynamic  and  the  stochastic  aspects  of  tarpet  motion.  Two  classes  of  tarpet 
models  are  investipated.  In  oiu-  class,  the  tarpet  acceleration  is  modeled  as 
a first  order  Markov  process;  in  the  other  class,  the  acceleration  is  modeled 
as  a second  Oi-dor  Markov  process.  Based  on  their  performance  apainst  the  FACT 
data,  a recommendation  is  made  as  to  the  filter  desipn  that  should  be  incorpor- 
ated into  an  air  defense  fire  control  system. 

All  test.s  of  filter  perform/uice  are  done  by  exercisinp  the  filter  apainst 
the  FACH'  data.  This  data,  which  provides  tarpet  position,  velocity  and  acceler- 
ation in  cartesian  coordinates  is  available  in  1/10  sec  increments.  Thus,  the 
samplinp  rate  lised  throuphout  the  report  is  10  data  points  per  second.  Further- 
more, of  the  20  flipht  paths  for  which  position,  velocity  .'ml  acceleration  data 
wai;  obtained,  12  are  ur.eable.  A classification  of  these  useable  flipht  paths 
is  provided  in  Table  1.  For  more  details  concerninp  I ACT,  the  reader  is  referred 
to  the  report,  "Trie  Krankford  Arsenal  Capabilities  Test"  (FACT)  July  197*' 
FA-TH-Y*'001 . 
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■I'AHU';  1 


FLIGHT  DATA  DIFMMARY 


Pass 

Path 

Ordinance 

1 

*<5°  Dive  Toss 

3 Bombs 

2 

30°  Dive  Toss 

Dummy  Run 

*♦5°  Dive  Toss 

Duminv  Run 

1*5°  Dive 

3 Bombs 

5 

30°  Dive 

Dummy  i*un 

6 

30°  Dive 

Dummy  Run 

7 

30°  Dive 

Dummy  Pun 

8 

1*5°  Dive 

Dummy  Run 

9 

Pop-up/dive 

Dummy  Run 

10 

Pop-up/dive 

Dummy  Run 

11 

Pop-up/dive 

Dummy  Pun 

12 

lAVdown 

Dumm:'  Pun 

11 


HECTinN  2 


GUMMARY  & CONCLUGIONG 


Several  filter  desif'ns  were  invest! jrated  for  possible  imolementation  in 
an  air  defense  weapon  system.  The  performance  of  each  desi«m  was  determined  by 
the  toal  RMS  error  in  the  estimates  of  tarpiet  position,  velocity,  and  accelera- 
tion. Each  design  was  "optimized"  in  the  sense  that  the  free  parameters  of  the 
desifrn  were  ad, justed  so  as  to  yield  the  most  accurate  state  estimates  (lowest 
RMT;  errors).  The  tarp;ets  for  which  these  filters  were  designed  were  not  simu- 
lated but  real.  That  is,  data  in  the  form  of  position,  velocity,  and  accelera- 
tion time  histories  of  real  aircraft  flyinp  simulated  combat  missions  was  used 
to  aid  in  the  selection  of  the  filter  desipn  parameters.  This  data,  called 
FACT  (Frankford  Arsenal  Capabilities  Test),  provided  inputs  into  the  filter 
via  the  weapon  system  sensor  model. 

In  addition  to  real  aircraft  data,  which  permitted  the  "optimization"  of 
filter  performance,  a simplification  of  the  usual  nine  state  filter  desipn  was 
souf'ht  in  order  to  minimize  the  computational  burden  of  the  fire  control  computer. 
This  simplification  was  successfully  achieved  by  decouplinp  the  nine  state 
filters  with  little  degradation  in  filter  performance.  Each  three  state  filter 
incorporates  a target  state  model  in  which  the  target  acceleration  is  mo<ieled 
as  a first  order  Markov  process.  Although  decoupled  filters  involving  more 
state  variables  were  designed,  it  was  found  that  they  did  not  offer  improved 
performance  against  the  FACT  data. 

A decoupled  four  state  filter  in  which  the  target  acceleration  was  modeled 
as  a second  order  Markov  process  was  also  designed.  This  design  was  piirposely 
constructed  in  such  a way  as  to  produce  an  acceleration  correlation  function 
that  is  represented  as  an  exponentially  decaying  sinusoid.  Although  the  target 
model  incorporated  into  this  four  state  filter  appeared  to  be  more  realistic, 
the  performance  of  the  filter  nevertheless  did  not  prove  to  be  superior  to  the 
three  state  design. 

In  most  simulations  involving  filter  performance,  the  fire  control  sensor 
was  modeled  to  provide  psosition  information  only  with  a standard  deviation  in 
the  range  error  of  10m  and  a standard  deviation  in  the  azimuth  and  elevation 
errors  of  IM.  Nevertheless,  the  performance  of  rate  aided  filters  as  well  as 
filters  using  more  accurate  sensor  inputs  was  also  investigated. 

The  conclusions  reached  in  this  report  are  summarized  as  follows: 

i)  The  three  filters  which  require  no  matrix  inversion  for  the  solu- 
tion for  the  state  estimates  in  rectangular  coordinates  offer  a 
simple  filter  design  and  adequate  target  state  estimates  (i.e.  - 
position,  velocity,  and  acceleration). 

ii)  The  three  state  filters  are  characterized  by  a 2 second  settling 
time  against  targets  undergoing  constant  Ug  maneuvers. 

iii)  For  a sensor  providing  position  data  only  and  characterized  by  a 10m 

standard  deviation  in  range  and  a Irf  standard  deviation  in  both  azimuth 
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and  elevation  measurements,  the  avera^!;e  RMT  position  measurement 
errors  over  all  the  flight  passes  contained  in  FACT  is  11.3m. 

The  three  state  filters  reduce  the  RMS  position  error  by  3T?5  to 
an  average  value  of  7.1m. 

iv)  The  three  state  filters  do  not  perform  as  well  as  a single  nine 

state  filter.  This  is  to  be  expected.  Nevertheless,  the  degrada- 
tion in  performance  is  minimal.  Over  the  ensemble  of  flight  paths 

considered  (12  in  number),  the  decrease  in  the  RMf  error  of  the  state 
estimates  for  the  nine  state  filter  over  the  three  state  filter  is 
as  follows ; 

a)  2.7?  decrease  in  position  RMl  error 

b)  10-9?  decrease  in  velocity  RMT-  error 

c)  l6.1»f-  decrease  in  acceleration  RMS  error 

The  10.9?  and  l6.U?  figures  are  of  little  practical  significance  when  the  actual 
RW3  values  are  compared.  For  the  velocity  RMS,  the  nine  state  filter  yields  a 
value  of  13.1m/sec  vs.  1^.7m/sec  for  the  three  state  filters  and  for  the  accel- 
eration RMS,  the  figure  are,  respectively,  19-3m/sec^  and  l8.3m/sec2. 

v)  The  three  state  steady  state  filters  (fixed  gain  filters)  perform 
almost  as  well  as  the  non-steady  state  three  state  filters.  The 
difference  in  performance  is  negligible.  The  storage  requirements 
and  computational  complexity  are  both  minimal. 

vi )  If  the  accuracy  of  a position  only  sensor  is  doubled,  that  is,  the 
standard  deviations  of  the  range,  ar.imuth  and  elevation  errors  are 
reduced  from  10m,  1#(,  Iji  to  9m  and  l/2j^  1/2M  respectively,  then  the 
position  state  estimates  improve  by  a factor  of  1 .9  to  1 whereas  the 
velocity  and  acceleration  estimates  improve  by  factors  of  3 to  2 
and  6 to  9 respectively. 

vii)  Addition  of  rate  measurements  (the  accuracy  of  position  measurements 
remains  fixed  at  a values  of  10m,  1^,  and  li^)  characterized  by 
standard  deviations  in  range  rate,  azimuth  and  elevation  rates  of 
9 m/sec  and  l/2Sl/sec,  l/2Bi/sec  results  in  the  following  improvements 
in  the  state  estimates.  The  position  estimates  im.p^’ove  in  accuracy 
by  a factor  of  2.3  to  1,  whereas  the  velocity  and  acceleration 
estimates  improve  by  factors  of  It  to  1 and  9 to  9 respectively. 

viii)  In  view  of  vi)  and  vii),  it  apjears  that  addition  of  rate  measure- 
ments (of  the  relative  quality  given  in  item  vii)  improves  the 
accuracy  of  the  state  estimates  to  a greater  extent  than  does  the 
doubling  of  the  accuracy  of  position  only  sensors.  The  position- 
rate  sensor  improves  filter  performance  over  the  improved  position 
only  sensor  by  a factor  of  6 to  9 In  position,  2.7  to  1 in  velocity, 
and  3 to  2 in  acceleration. 
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ix)  In  items  i)  thnjuf'.h  vi  i ) , the  sensor  noise  was  modeled  as  bein;^ 
uncorrelated  in  time.  If  the  sensor  model,  as  it  appears  in  the 
filter  equations,  remains  unchanp-ed  but  the  sensor  data  which  is 
in{)\jted  into  the  filter  is  time  correlated  with  a correlation  time 
constfU't  of  .1  sec.,  then  the  state  estimates  imiuove  sirni  ficantly . 
rpec  i f ical  ly  , the  KMf  position  errors  drofp  by  wh*.*reas  t.he 

velocity  and  acceleration  HW  errors  decrease  by  and  I'lf 

respectively . 

A brief  incursion  into  the  area  of  process  identification  was  made  for 
the  purpose  of  pettinp:  some  handle  on  the  approximate  values  of  the  filter  design 
parameters.  The  most  significant  result  of  this  brief  study,  however,  was  that 
the  tarp^et  acceleration  could  not  be  statistically  characterized  as  beinp  a 
stationary  process.  Whether  or  not  it  is  Gaussian  remains  in  doubt  althouph  no 
firm  conclusion  in  this  repard  could  be  mAde  with  the  data  that  was  available. 
Furthermore,  the  statistical  behavior  of  the  acceleration  process  appeared  to 
be  strongly  dependent  upon  the  target  attack  mode.  This  information,  it  was 
recognized,  could  be  useful  in  the  design  of  adaptive  filters.  A thorough 
study  of  the  available  flight  data  using  autoregressive  models  will  undoubtedly 
provide  some  very  useful  information  which  is  needed  for  the  purpose  of  obtain- 
ing good  statistical  models  of  target  motion.  Fuch  models  would  provide  not 
only  a means  of  further  eniiancing  the  quality  of  target  state  estimates,  but 
would  also  firovide  a means  of  better  predicting  the  future  position  of  the 
target,  which  is  ultimately  what  is  desired.  The  only  requirement  is  that 
plenty  of  data,  representative  of  the  threat  posed  to  air  defense  systems,  be 
available  for  further  analysis. 


II4 


HECTION  3 


PROROTYrK  FILTER  DEGION  - NINE  STATE  FILTER 
MODEL  OF  THE  PLANT 


The  filter  described  in  this  section  hns  nine  state  variables,  three  for 
each  of  the  components  of  target  position,  velocity  and  acceleration.  Althouf^h 
this  filter  is  not  proposed  for  use  in  an  actual  air  defense  system,  it  is 
described  here  for  two  reasons.  First,  it  provides  a logical  framework  from 
which  a class  of  lower  order  filters  can  be  constructed.  Second,  the  proposed 
filter  desifrn  will  be  tested  apainst  this  nine  state  filter.  One  will  then  be 
able  to  .judge  the  degradation  in  filter  performance  when  certain  simplifying 
approximations  are  made. 

The  target  position  variables  are  labeled  in  Figure  1.  Wo  model  each 
component  of  the  target  acceleration  as 


k’igure  1 . Sensor  Variables  in  Inertial  Coordinate  Set 

a first  order  Markov  process.  Thus,  if  xj  = x is  the  state  variable  for  the 
X component  of  target  position,  we  model  the  target  motion  along  X as 


(3-1) 

CM 

X 

M 

• X 

(3-2) 

X2  = X3 

(3-3) 

^ = -aiX3  + b^ujj 

where  u represents  white  noise.  The  quantity  a^  is  related  to  the  correlation 
time  for  the  acceleration  process  and  b^^  is  the  intensity  of  the  white  noise. 

It  is  best  to  obtain  a numerical  value  for  aj^  experimentally  in  such  a way  as 
to  optimize  the  filter  performance.  A suitable  value  of  a^^  can,  however,  be 
obtained  from  theoretical  considerations. 

The  equations  describing  the  target  motion  in  the  remaining  two  components 
are  identical  in  form  to  the  above  model  for  motion  along  X.  Thus,  there  are 
nine  state  variables  and  nine  linear  differential  equations  describing  the  tar- 
get motion.  The  state  equations  are 
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1 


(3-M 

*1 

{ 3-9) 

*2 

{ i-0) 

(3-T) 

(3-8) 

(3-9) 

*6 

( 3-10) 

(3-11) 

^8 

(3-12) 

*9 

*2 

*3 

-»1M  + ‘^x'*x 
*6 

-^2*6  ^ 

’'8 

-®3V 


where  xi|  and  Xj  are  the  y and  z components  of  tarfxet  position  respectively. 
Because  there  is  no  preferred  direction  in  the  horizontal  plane,  a]  = and 
bjj  = b . There  is  no  a-priori  reason,  however,  for  assuming  that  a^  = a^  . 


These  equations  can  be  written  more  concisely  in  matrix  form  an 
( 3-13)  X = F > ♦ G u 
where,  by  inspection 


Xg 


X = 


0 10 
0 0 1 

0 0 -Sj 


0 0 0 
0 0 0 
0 0 0 


0 0 0 
0 0 0 
0 0 0 


• I 

0 10 
0 0 1 

0 0 -a^ 


0 = 


0 0 0 

0 0 0 

b„  0 0 

0 0 0 

0 0 0 

0 b 0 

0 0‘  0 

0 0 0 

0 0 b^ 


u = 


u 

u 

a 


1 

2 

3 


Because  sensor  data  comes  in  discrete  form,  the  discretized  form  of  the  Kalman 
filter  equation  will  be  implemented.  Once  discretized,  the  plant  equations  take 
the  form 


1 


l6 


where  (Appendix  B) 

(3-15)  = ♦ (A)  = 

with 


♦x  ° ° 

0 0 
0 0 


(i-l6)  (i  = X,  y,  7.)  = 


1 A 


0 1 


0 0 


and 


(3-17) 


-f\ 


( T ) G d T 


A ] , -a  I A , , 

- + ~2  ' -1, 


i , -a'l  A\ 
7 U - e - ) 


-ai  A 

3 


Here,  A is  the  time  interval  between  measurements. 


The  (^1  is  a time  averaged  white  noise  sequence  obtained  from  the  continuous 
white  noise  process.  That  is. 


(3-18) 


. I 

“1*4/ 

J nA 


(n+1.  )A 


Uj  (t  ) dt 


( V = 1,2,3) 


The  error  convariance  matrix  for  the  process  described  by  Equation  (3-1^) 
is  found  by  evaluating  E((Ofjio^)  wiiere  E is  the  expectation  operator.  Assuming 
, uj2»  to  be  statistically  independent,  the  error  covariance  matrix  defined 
by  Q is 


(3-19)  y = 


From  (3-18), 


E( 


E(uip  0 0 

0 E(to^)  0 
L> 

0 0 E(w^) 

3 


2v  1 

\ - ~o  I I U (t)  u (t)  dt  dT 

' y 0 y 0 ‘ ' 
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E [u^  (t ) Uj  (t ) ] dt  dT 


i 

o 

1 


where  the  integration  is 


t L 


over  the  time  interval  A. 


Thus , 

(3-20)  Q = i 1 
A 

where  I is  a 3 x 3 identity  matrix. 


The  autocorrelation  function  for  this  process  has  a very  simple  form.  If 
Ri  (r)  with  i ^ X,  y,  z is  the  autocorrelation  function  for  the  target  acceler- 
ation along  the  ith  coordinate,  then  (Appendix  C) 


(3-21)  (t) 


2ai 


Thus,  aj  is  related  inversely  to  the  correlation  time  as  stated  earlier. 
Furthermore,  by  setting  t = 0,  Rj  (t)  becomes  the  variance  of  the  acceleration 
along  the  ith  direction.  That  is. 


(3-22) 


2a  i 


Tfius,  if  one  has  some  knowledge  of  the  aircraft  RMS  acceleration  as  well  as  the 
correlation  time  for  the  acceleration  process,  one  can  determine  the  intensity 
b,  of  the  white  noise  process  from  the  above  equation. 

So  far,  no  Justification  has  been  given  for  the  particular  target  state 
model  assumed  here.  The  true  target  acceleration  may  indeed  be  a second  or 
higher  order  Markov  process.  Unfortunately,  the  variety  of  target  models  is 
too  numerous  to  meike  a thorough  evaluation  of  each  model  practical.  Nevertheless, 
reasonable  alternatives  to  the  acceleration  process  described  here  are  considered 
in  subsequent  sections  of  this  report  with  the  conclusion  tliat  modeling  accelera- 
tion randomness  as  a first  order  Markov  process  is  indeed  adequate. 


MODEL  OF  THE  OBSERVATIONS 


It  is  assumed  that  the  sensor  provides  measurements  of  R,  0,  and  'C  as 
defined  in  Figure  1.  Fiirthermore , the  measurements  ai-e  assumed  to  be  statis- 
tically independent  quantities  whose  noise  components  have  zero  mean  and  known 
values  of  standard  deviation.  The  observations  are  taken  to  be  the  three 
components  of  position  measurements  in  cartesian  coordinates  with  addative  white 
noise.  Thus, 
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( <-;m)  z]  = xx  + V| 
(i-.'h)  7.^  - XI,  V;. 


(3-^5)  Z3  = Xy  + V3 


The  covariance  matrix  ^ of  the  observation  noise  is  non-diagonal  due  to  the 
coupling  of  the  noise  terms  along  x,  y,  and  z through  the  measurements  R,  0,  and 
vj.  Indeed,  R is  state  dependent  because  of  the  dependence  of  the  observation 
errors  v^^ , V2,  and  v^  upon  the  target  state. 


In  matrix  form,  the  observation  equations  are  written  as 
{ 3-26 ) z = Hx  -*•  Dv 
where,  by  inspection. 


1 

0 

0 

0 

0 

0 

0 

0 

0 

V , 

H = 

0 

0 

0 

1 

0 

0 

0 

0 

0 

, D = I,  V = 

''2 

0 

0 

0 

0 

0 

0 

1 

0 

0 

^3. 

_ 

. 

with  I a 3 X 3 identity  matrix. 
By  definition. 


(3-27)  R = E[v  v'^] 


a vx  ^(Vj^Vg) 

E(vxV2)  Ov^2 

ECv^v^)  ECvgV^) 


E(vj^v^) 

E(v2V3) 


2 2 2 

Given  the  variances  of  the  errors  in  R,  0,  and  , namely  Oj^,  , and  , 

one  obtains,  in  a straightforward  manner,  the  elements  of  R explicitly.  From 
Appendix  D, 


(3-28)  Rxx  = Ovx 


^ = R^  [o0^cos‘^e  cos*^,?  + OQ^o^‘^cor;‘^0  siri  i^  + c^'^sin'^S  sin'^^] 


2 2 2„ 


2.2. 


+ o^sin^e  cos^'fi 
a 

(3-29)  R^2  ~ ^21  “ E(vxVg)  = R^sin^i^  cos^^  [og^cos^e  - o^^sin^O] 

2 2 

+ OpSin  0 sinv>  cosip 

2 2 2 

(3-30)  Rx3  = R3X  = E(vxV3)  = (op  - R 09  )cos0  sinu  cos>^ 

2 2 2 

(3-31)  R23  = R32  “ E(v2V^)  = (op  - H Oq  )cos0  sinO  sinv? 
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p222  2 222  2 22  2 

(3-32)  R„2  = = R [o  sin  6 cos  + Oq  o cos  \p  cos  6 + Oo  cos  6 sin  ~f 


'22  '^V2 


e 


2.2  .2 

+ Oj^  sin  6 sin 

(3-33)  ” '^V:3^  ~ ^ ^0^  sin^O  + cos^'O 


Iti  implementing  the  Kalman  filter,  one  may  use  either  current  state  esti- 
mates to  determine  R,  0,  and  for  use  in  the  ^matrix  or  raw  sensor  values. 
Because  these  two  alternatives  give  virtually  the  same  numerical  values  for  the 
matrix  elements  for  R,  the  simpler  alternative  of  using  sensor  values  for  R, 
e,  and  < will  be  used  to  compute 


It  will  be  shown  in  Section  lU  that,  for  the  proposed  filter  design,  the 
elements  of  R can  be  replaced  by  numerical  constants  with  little  loss  in  filter 
performance.  Indeed,  unless  this  is  done,  the  gains  never  reach  steady  state 
values.  By  using  steady  state  gains,  one  can  investigate  the  performance  of  an 
exceedingly  simply  steady  state  filter  design. 
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SECTION  1* 


INITIAI.IZATION  OF  THE  FILTER 

In  ail  filter  simulations,  a standard  procedure  described  in  this  section 
will  be  used  to  initialize  the  state  vector  ^ as  well  as  the  state  estimation 
covariance  matrix  P. 

The  procedure  for  initializing  ^ is  straightforward.  Four  position 
measurements  are  made,  where  the  last  measurement  is  used  as  the  initial  value 
of  target  position  and  the  first  and  fourth  measurements  are  used  to  compute 
the  velocity  components.  Tliat  is,  if  Zj^(O)  and  Zj^  (3A)  represent  the  ith  compo- 
nent of  measured  position  at  times  t = 0 and  t = 3A,  where  A is  the  time  between 
observations,  then  the  Jth  component  of  initial  velocity  state  is 

Zi(3A)  - Zi(0) 

(l*-l)  x,(0)  = 

3A 

where  J =2,  5 or  8 depending  on  whether  i is  x,  y,  or  z.  The  use  of  four 
observations  is  rather  arbitrary. 

The  initial  acceleration  estimate  is  set  to  zero.  Position  measurements 
are  not  used  to  estimate  tau'get  acceleration  since  this  procedure  yields  ex- 
ceedingly noisy  results.  Indeed,  it  is  not  impossible  to  be  in  error  by 
several  hundred  percent  using  raw  sensor  measurements  to  estimate  a -'celcrat  ion . 
It  is  therefore,  best  to  initialize  the  acceleration  to  its  expectei  valu« , 
namely  zero. 

The  elements  of  the  state  covariance  matrix,  defined  by  L'[ ~ x,, ) 

vw  f n e. 

(xf,  - Xq)  ],  where  ^ is  the  initial  state  estimate,  are  easily  computed. 

Since  the  initial  position  estimate  is  a raw  sensor  position  measurement,  we 
have 


-2) 

J'll 

= E[(xi 

(0)  - 

xj.(0))2] 

= E(zj^  - 

- x^)^  = E(vf) 

= Ril 

{h. 

-3) 

Puu 

= E[(x], 

(0)  - 

xi,(0))2] 

= E(z2  - 

- xj,)^  = E(v2) 

= R^^ 

(1*. 

-U) 

^77 

= E[(x.^ 

(0)  - 

x.f(0))2) 

= E(z^  - 

- Xj)^  = E(v^) 

= R33 

(14. 

-5) 

Pl4 

= ^1  = 

Rio 

('*■ 

-6) 

'17 

= Pj^  = 

Ri3 

{U. 

-7) 

= = 

«23 
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wtiero  the  elements  of  R are  given  in  the  previous  section.  The  remaining 
elements  of  , with  the  exception  of  the  elements  relating  to  the  target 
acceleration,  are  computed  in  Appendix  E with  the  following  results: 


(4-8) 

^2 

(4-9) 

^5 

(4-10) 

^18 

(4-11) 

^1 

(4-12) 

^5 

(4-13) 

^48 

(4-14) 

^2 

(4-15) 

^75 

(4-lh) 

^78 

'’zi  " 3A  ’^11 

^51  “ 3A  ’^12 

P R 

81  ■■  3A  13 

P -1  R 
lA  ~ iA  '^12 

P -i  R 
54  ■ 3A  22 

P - -i  R 
84  " 3A  23 

P - 1 R 
27  " 3A  '^13 

P = — R 
57  3A  23 

87  “ 3A  *'33 


The  elements  of  R ai-e  evaluated  at  the  end  of  the  time  interval  3A  (i.e.  - 
after  the  fourth  sensor  position  measurement).  The  velocity  variance  and 
velocity  cross  terms  are 


(4-1 7) 
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R^  ^(3  A ) 4-  R^^(O) 
(3  A )2 


(4-18)  P55 
(4-19)  P„„ 


8^2(34)+  822^0) 
(3  A )^ 

R^.j(3A)+  R^^(O) 

(3  A )^ 
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(4-20) 


A ) + 

(3  A )^ 


(4-21)  P = P 

i^g  - t'g2 


Rj3(3  A ) + R^jCO) 
(3  A )‘^ 


(A-22)  P = P 

58  85 


8^3(3  A ) + R23(0) 
(3  A )2 


Hy  ailmitting  total  ignorance  of  target  acceleration,  the  variance  of 
each  component  of  the  initial  acceleration  estimate  is  set  equal  to  (3g)^ 

(g  = 9.Bm/sec^).  Thus, 

'■js  ■ ’’66  ■ ’■99  ’ 

with  the  remaining  elements  of  ^ set  equal  to  zero. 

It  is  not  obvious  that  this  elaborate  procedure  for  initializing  the 
Kalman  filter  is  realxy  necessary.  It  may  be  argued  that  suitable  results  will 
be  obtained  by  initializing  the  filter  with  some  constant  pre-letermined  values. 
Experience  early  in  the  program,  however,  has  shown  that  some  estimates  for 
initial  conditions  can  lead  to  long  settling  times  and  indeed,  a bad  c.hoice  of 
initial  conditions  can  lead  to  instability  in  the  Kalman  equations  resulting 
in  divergence  of  the  elements  of  P.  The  above  procedure  eliminates  the  guess- 
work associated  with  initialization  of  the  Kalman  filter  and  is  therefore  used 
in  all  subsequent  computer  simulations. 
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SECTION  5 


SUBOPTIMAL  FILTEB  DKfllGN  PHIIX)201'HY 


The  filter  described  in  the  preceeding  section  has  nine  state  variables. 
Implementation  of  the  filter  equations  therefore  requires  matrix  inversion  at 
each  step  of  the  iteration  process.  If  one  can  eliminate  the  need  to  perform 
matrix  inversion  at  each  iteration  step,  then  one  will  have  reduced  significantly 
the  execution  time  for  the  solution  to  the  state  estimates.  Of  necessity,  how- 
ever, one  must  pay  the  penalty  of  degrading  the  accuracy  of  the  state  estimates 
since  reduction  of  the  complexity  of  the  filter  discussed  heretofore  generally 
results  in  some  loss  of  information,  either  about  the  plant  or  the  observation 
models  or  both.  Nevertheless,  if  the  degra/iation  in  filter  performance  ir 
small,  simplification  in  the  filter  design  may  be  Justified. 

A considerable  simplification  results  when  one  considers  the  following 
design  modification:  Instearl  of  using  a single  nine  state  filter  in  whicii  the 
three  cartesian  coordinates  are  coupled  via  the  polar  measurements  K,  6,  g, 
design  three  separate  and  independent  filters,  one  for  each  cartesian  coordinate. 
In  such  a design,  information  about  the  coupling  is  lost,  but  the  decrease  in 
complexity  is  significant.  Thus,  the  nine  state  filter  is  replaced  by  thi-ee 
independent  three  state  filters.  The  need  to  perform  matrix  inversion  is  then 
replaced  by  inversion  of  a single  number.  Henceforth,  the  filters  described 
will  all  have  this  simplifying  feature.  The  only  exception  is  the  discussion 
in  Section  21  in  which  the  performance  of  the  nine  state  and  the  three  state 
filters  is  compared. 


SECTION  G 

THE  five  state  KILTER 
MCLiEL  OF  THE  PLANT 

Here,  we  consider  a filter  in  which  the  acceleration  process  is  mcde.ei  as 
the  sum  of  two  terms:  a deterministic  term  auid  a stochastic  tern.  The  stochastic 
portion  of  the  acceleration  is  modeled  as  a first  order  Mai'kov  process.  Thus, 
for  each  of  the  three  cartesian  coordinates,  we  have  the  following  model  of 
the  target  motion; 

(6-1)  = X2 

(h- 2)  X2  = Xj  Xi^ 

(6-3)  *3  ~ -'ix^  + bii) 

(6-L)  xj^  = x,^ 

(6-5)  x^  = 0 

where  xp  is  the  target  position  along  one  of  the  three  cartesiari  axes.  This 
model  assumes  that  the  rate  of  change  of  the  deterministic  portion  of  the 
acceleration  is  coiistant . 

In  matrix  form, 

(6-6)  X ^ Fx  6u) 

where,  by  inspection 
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Discretizing  the  plant  equation  leads  to 


(6-T)  ^n+l  ~ ^n*n  *^n“n 
where  (Appendix  E), 


(6-8)  = 4>  (A)  = 


1 

A 

0 

1 

- e-aA) 

0 

0 

e-aA 

0 

0 

0 

0 

0 

0 

- e-aA) 


1 1 a2  1 

J 2 r 


A 

0 

1 

0 


(6-9)  a 


(t  ) G di  = 


a '2  a^  3 ® ‘ 

a 


- (aA  - (1 


- (1  _ e-aA) 


.-aA 


)) 


0 

0 


and 


(6-10) 


( n+1 ) A 
nA 


w (t)  dt 


The  correlation  function  for  the  stochastic  portion  of  the  acceleration  i 
the  same  as  for  the  nine  state  filter.  Thus, 

(6-11)  R(t)  =1^  e-^lTl 

From  the  equations  for  the  state  variables  and  x^ , 

(6-12)  x^  = u 

(6-13)  x^  » e + a t 
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At  t = 0,  xi^  = B and  = a.  These  are  set  equal  to  zero  for  ^ 


MODEL  OF  THE  SENSOR 

With  obvious  minor  modifications  in  the  observation  model  is  as  described 
in  section  3*  Unless  otherwise  stated,  the  sensor  is  henceforth  characterized 

by  a range  variance  of  lOOm^  and  angular  error  variances  o ^ , a ^ each  of  ini^ 

R e ^ 

It  will  be  shown  in  Section  lb,  however,  that  the  elements  of  K can  be  repjaced 
by  constant  elements  with  no  degreidation  in  filter  performance. 
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SECTION  7 


MODIFIED  FIVE  STATE. FILTER  - THE  FOUR  STATE  FILTER 


An  obvious  modification  of  the  five  state  filter  results  when  Equation 
(6-L)  is  replaced  by  = 0.  That  is,  the  deterministic  portion  of  the  accel- 
eration is  modeled  as  being  constant.  This  results  in  a reduction  in  the  r..c:.bfcr 
of  state  variables  from  five  to  four.  The  four  state  target  model  is  then 

(T-I)  X]^  = ^2 

(7-2)  X2  = + XI, 

(7-^)  x^  = -ax^  + boi 

(7-i*)  XI,  = 0 

The  F and  G matrices  are  modified  in  an  obvious  way,  with  corresponding 
modifications  in  Fj,  and  Gj,.  Their  explicit  form  will,  therefore,  not  be  given 
here. 
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SECTION  8 


1 

I^EGULTS 


The  fourth  and  fifth  order  filters  for  the  y component  of  target  motion 
were  optimized  for  flight  passes  1 and  9 (Tables  2 and  3).  Optimization  pro- 
ceeded in  the  following  way:  From  Equation  (6-ll),  R(0)  = , where  is  the 

variance  of  target  acceleration  (in  this  case,  along  the  y coordinate).  Then, 

o b2 

(8-1) 

Given  and  a,  one  can  then  solve  for  the  parameter  b^.  For  a given  value  of 
a,  it  was  determined  that,  in  general,  an  acceleration  variance  of  1000  (.m/sec^)^ 
results  in  best  filter  performance.  This  value  of  is  used  throughout  the 
report.  For  each  value  of  a,  the  RMI3  of  the  target  position,  (in  this  case  the 

y component),  velocity,  and  acceleration  errors  Cy,  Cy,  cy  is  computed  over  the 

entire  run.  The  filter  is  said  to  be  optimized  wnen  a value  of  a is  chosen 
which  results  in  the  smallest  RMS  values  for  Cy,  ey,  Cy.  The  value  of  a which 

optimizes  filter  performance  is  henceforth  called  the  optimal  value  of  a. 

TABLE  2 

COMPARISON  BETWEEN  THE  FOURTH  AND  FIFTH  ORDER  AND 


FILTERS 

ALONG 

THE  y 

COORDINATE  FOR  PA;’.S  NO. 

1 

a 

a 

RMS(y-y) 

RHS(y- 

HMS(i- 

■y 

Orders 

Orders 

Orders 

Uixiei' 

■s 

Uth 

5th 

Uth 

5th 

Uth 

5th 

Uth 

5t  h 

.001 

.001 

9.3 

8.9 

li4.2 

lU.L 

11. 1 

xl.T 

.01 

.01 

5.3 

5.3 

9.3 

9.5 

9.5 

9.9 

.05* 

.05* 

'*.9 

'*.9 

8.3 

8.5 

8.9 

9.3 

.08 

.08 

5.0 

5.0 

8.5 

8.6 

8.9 

9.2 

1 

• ji. 

.1 

5.0 

5.0 

8.6 

8.,’ 

9.0 

9.2 

.5 

.5 

5.14 

5.»4 

10.2 

10.2 

10.8 

10.9 

1.2 

1.2 

5.5 

5.5 

10.8 

10.9 

12.14 

12.5 

I 
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TABLE  3 


COMPARISON  BETWEEN  THE  FOURTH  AND  FIFTH  ORDER  AND 
FILTERS  ALONG  THE  y COORDINATE  FOR  PASS  NO.  9 


a 

RM3(y- 

-ll 

RMS(y- 

-11 

RMS(y-i 

11 

Orders 

Orders 

Orders 

Orders 

l*th 

5th 

Uth 

5th 

l4th 

5th 

i^th 

5th 

.001 

.001 

11.6 

11.3 

17.5 

17.6 

13.5 

13.9 

.01 

.01 

6.6 

6.5 

11.2 

11.3 

11. U 

11.7 

.07* 

.07* 

5.8 

5.8 

9.9 

10.1 

10.6 

10.9 

.12 

.12 

5.8 

5.8 

10.1 

10.3 

10.7 

10.9 

1.0 

1.0 

6.0 

6.0 

11.3 

11. 14 

12.5 

12.3 

1.2 

1.2 

5.5 

5.5 

10.8 

10.9 

12.5 

12.5 

As  seen  in  Tables  2 and  3,  there  is  very  little  difference  in  performance 
between  the  l^th  and  5th  order  filters.  Furthermore,  the  optimal  values  of  a 
(those  with  an  asterisk)  for  both  filters  are  the  same.  More  extensive  runs 
for  these  filters  were  not  made  in  view  of  the  results  obtained  for  the  filter 
proposed  for  use  in  air  defense  (see  Section  15).  That  is,  the  ^*th  and  5th 
order  filters,  which  involve  more  state  variables  than  the  proposed  filter, 
do  not  offer  improved  performance. 
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SECTION  9 


PROCESS  IDENTIFICATION 


As  mentioned  previously,  a value  for  the  parameter  "a"  appearing  in  the 
equation  for  X3  (Equations  (6-3),  (7-3))  can  be  obtained  from  theoretical  con- 
siderations. In  this  report,  two  basic  acceleration  models  for  the  stochastic 
portion  of  the  acceleration  are  investigated  - a first  order  Markov  model  and 
a second  order  Markov  model.  Consider  the  first  order  liarkov  model 

(9-l)  X = -ax  + b(D. 


In  discrete  form, 

(9-2)  Xfj+j^  = *n  ■ '^“^n  ^^n 

where  A is  a small  time  increment  and  the  subscripted  Lntiger  n means  that  the 
variable  to  which  it  is  affixed  is  evaluated  at  the  time  nA.  Observe  that  x^ 
independent  of  lOn-  Multiplying  Equation  (9-2)  by  x^  and  taking  the  expected 
value  of  both  sides,  one  obtains  •• 

(9-3)  E(xjjXfi+i)  = (1  - Aa)E(x„) 

where  the  assumption  that  the  mean  of  the  white  noise  sequence  cjjj  is  zero  was 
used.  Observe  that  the  expectation  operator  acts  over  an  ensemble.  Now  assume 
that  the  process  is  stationary  and  ergotic.  Then,  the  ensemble  statistics  are 
the  same  as  the  statistics  over  time.  Specifically, 

(9-i+)  E(XfjXfj+jj)  = 1>  (k) 

for  all  n where  i (k)  is  the  correlation  function.  Tims, 

(9-9)  * (A)  = (1  - Aa)  ♦ (0) 

or 


where  (O)  is  normalized  to  unity. 


The  procedure  for  obtaining  expressions  for  the  appropriate  variables  in  the 
second  order  Markov  model  is  similar  to  the  one  above.  The  same  assiunptions 
about  ergodicity  and  the  mean  of  the  white  noise  sequence  ai'e  made. 

The  model  for  the  second  order  Meu-kov  process  is 


(9-T)  X3  = X)^  + w 

(9-8)  xj^  = -0^X3  - 26xi,  + (a  - 26 )o). 
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(The  reason  for  this  particular  form  of  the  model  is  given  in  Section  12). 
Discretize  each  equation  to  obtain 

(9-9)  x^(n  + l)  = + Axj^(n)  + Auj(n) 

('^-10)  X4(n  + J)  = xi;(n)  + a^Ax3(n)  - ;’(iAx)j(n)  + (a  - 2(0Aa)(n) 

Now  solve  for  X3  and  drop  the  subscript  3.  That  is,  define  Xjj  = X3(n).  Then, 

(9-11)  Xjj+2  2(6A  - l)xn+i  + (1  + o2a2  - 2SA)xn  - Au^+j^  + (A  - 0 

fiu It i plying  through  by  Xn  and  taking  the  expected  value  of  both  sides, 
one  obtains 

(9-12)  41  (2A)  + 2(8A  - 1)  4 (A)  + (l  + a^A2  - 26A)  = 0 

A second  equation  involving  a and  6 caji  be  obtained  by  multiplying  Equation 
(9-11)  by  Xn_i  then  taking  the  expected  value  of  the  resulting  expression.  The 
result  is 

(9-13)  4 (3A)  + 2(6A  - 1)  4>  (2A)  + (1  + a^A^  - 2gA)  * (A)  = 0 

Solution  of  Equations  (9-12)  and  (9-13)  for  a and  B gives 

+ 2 

(0-11.)  B = 

euld 

26A  + ?2  - 1 

(9-15)  ot^  = 

a2 

where 

4>(a)4i(2A)  - 4(3A) 

(9-16)  P,  = 

♦(2A)  - 4(A)2 

(9-17)  Pg  = -♦(2A)  - P_^f(A) 

The  correlation  function  4(k)  is  computed  from  the  definition 

N - k 

(9-18)  4(k)  = E xi*i+k 

i = 1 

where  N is  the  number  of  available  data  points. 
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Tables  5 through  7 list  the  computed  values  of  "a"  using  Equation  (9-6) 

2 2 2 

for  each  of  the  12  FACT  flight  passes.  With  Wq  defined  by  - 6 , Tables 

8 through  10  list  the  computed  values  of  and  6 which  parameterize  the 

second  order  Markov  acceleration  process.  Table  U lists  the  number  of  data 
points  in  each  flight  path  as  well  as  the  number  of  data  points  in  each  of  the 
three  segments  for  each  flight  path.  Each  segment  is  characterized  by  a specific 
portion  of  the  flight  path.  Segment  1 defines  that  portion  of  the  flight  path 
during  which  the  aircraft  undergoes  evasive  maneuvers  prior  to  weapon  delivery. 
Segment  2 is  characterized  by  that  portion  of  the  flight  path  during  which  the 
pilot  is  constrained  to  follow  a particular  course  in  order  to  deliver  his 
ordinance  on  target.  It  is  taken  to  start  5 seconds  before  weapon  release. 
Segment  3 is  the  remaining  portion  of  the  flight  path.  Mean  acceleration  values 
for  each  of  the  three  portions  as  well  as  the  standard  deviation  of  the  acceler- 
ation along  the  entire  run  £ire  also  provided  in  Tables  5,  6,  and  7.  The  d.it.a 
points  are  separated  by  1/10  second  Intervals. 

TABLE  h 

NUMBER  OF  DATA  POINTS  FOR  EACH  FLIGHT  PATH  AND 
FOR  EACH  SEGMENT  OF  A FLIGHT  PATH 


I'lirht  Pass 

N 

N 

N 

U 

Number 

Total 

Sep  1 

Set;  2 

Sep  ; 

1 

36-9 

142 

51 

172 

2 

483 

329 

51 

103 

•3 

3R3 

221 

M 

113 

4 

412 

261 

51 

100 

5 

405 

329 

■■■I 

c.  ■ 

6 

345 

20<. 

51 

w 

7 

378 

220 

.3 

H'Y 

8 

331 

171 

M 

lY) 

9 

3F.I 

51 

(\h 

10 

573 

443 

M 

7" 

n 

578 

• 

51 

2‘1 

1? 
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0 

33 


ITS 


5 


c 

o 

m 

r i 

CM  nn 

pr. 

'S 

■8 

t- 

CO 

VO 

m 

U> 

'D 

& 

t- 

a. 

<M 

cti 

IX 

CO 

cn 

On 

H 

H 

cn 

D 

U, 

CVl 

H 

in 

CM 

CM 

CM 

cn 

CM 

-:t 

cn 

U> 

CO 

•r~t 

fO 

h 

4-> 

UJ 

3 

C 

u 

o 

a: 

a. 

X 

Cri 

UN 

aj 

O' 

cn 

CO 

o^ 

IT 

t- 

a' 

o 

> 

o 

U1 

m 

CM 

d 

d 

6 

o> 

OJ 

rH 

d 

(T) 

CO 

* 

o 

f 4 

0> 

rH 

cn 

r4 

rH 

cn 

cn 

cd 

IX 

ro 

i 

1 

• 

f 

1 

1 

1 

c\j 


CM 

f j 


K 

f J 

Ul 

0> 

tn 

CM 

o 

--1 

a) 

t- 

t:' 

O'. 

rH 

o 

rH 

oo 

o 

UJ 

rH 

OJ 

Ox 

cn 

d 

CM 

CM 

CO 

t- 

CM 

CO 

0)1 

rH 

CM 

rH 

rH 

H 

rH 

CM  rn 

c/jI 

1 

1 

1 

1 

1 

1 

1 

1 

r/) 

»X 

cc 

D 

hH 

C*a 

C 

O 

< 

•rH 

■P 

rH 

in 

o 

CM 

00 

ON 

cn 

rH 

CM 

NO 

ON 

ro 

0) 

cn 

• 

• 

« 

• 

♦ 

• 

• 

• 

• 

• 

• 

*< 

IX 

CiC 

Cr^ 

o 

00 

rH 

rH 

CM 

CM 

rH 

0) 

4) 

rl 

rH 

rH 

rH 

Q 

f—1 

CO 

1 

1 

1 

1 

1 

1 

1 

t 

1 

U4 

OJ 

o 

W 

o 

« 

cd 

C 

( ■) 

s 

ci; 

o 

m 

C-- 

cn 

rH 

o 

cn 

CM 

tn 

CM 

-t 

a 

4> 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

o 

c 

ro 

ON 

rH 

VO 

CM 

CM 

ON 

cn 

cn 

o 

IX 

•rH 

H 

rH 

H 

•rH 

P 

1 

1 

1 

1 

1 

1 

1 

1 

1 

1 

1 

c 

pc 

cd 

U4 

pzi 

•rH 

> 

w 

4) 

t5 

, 

C-> 

oo 

< 

•O 

H 

CO 

CM 

in 

'O 

rH 

CM 

VO 

c- 

Va 

cd 

'iil 

, t 

o 

-rt 

*S 

6o 

S' 

CM 

o^ 

•K 

Ul 

0) 

4) 

rH 

'h 

H 

CM 

CO 

-•t 

CM 

o 

'rj 

(0 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

a 

rH 

fH 

<d 

p 

w 

cn 

o 

cn 

cd 

CM 

m 

. t 

00 

& 

CM 

CM 

0 

ON 

in 

S 

rH 

cd 

UJ 

CM 

rH 

in 

rH 

0 

rH 

cn 

CM 

rH 

in 

O 

.H 

4) 

NO 

CM 

CO 

rH 

CO 

CM 

CO 

VO 

CM 

m 

4J 

CO 

• 

• 

• 

• 

• 

• 

• 

« 

• 

• 

• 

X 

H 

CM 

CM 

K 

V) 

O 

cd 

z 

CM 

O'- 

(T\ 

cn 

NO 

GO 

t~ 

0 

CO 

J3 

o 

4> 

05 

UJ 

4) 

s 

r^> 

O 

0 

rH 

€ 

rH 

0 

cn 

0 

& 

CM 

CM 

cn 

0 

02 

rH 

0 

V) 

C/^l 

■ 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

O 

s 

•wT 

c 

U) 

.00 

w 

lx 

fc. 

3 

4) 

o 

H 

rH 

0 

rH 

on 

fO 

CM 

NO 

rH 

< 

> 

o 

♦rH 

cd 

•fH 

m 

O 

■3 

t- 

0 

S 

on 

0 

in 

0 

cn 

0 

03 

CM 

0 

rH 

0 

P 

P 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

(d 

O 

<< 

Ca 

w 

4> 

cn 

M 

rH 

(0 

fH 

4) 

0l 

H 

O 

K 

o • 

0) 

O 

Hi  Tl 

■p 

rH 

CM 

cn 

in 

VO 

t- 

00 

On 

0 

rH 

CM 

W 

u: 

4> 

H 

H 

rH 

CD  cn 

4)  *H  fH 

:%  rH  [U 


3^ 


No  data  points  available  for  computation 


TABLE  6 


No  data  points  available  for  computation. 
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Computation  of  uj_  results  in  imaginary  value. 
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Information  about  the  values  of  "a"  and  a and  6 is  useful  because  these 
values  provide  some  clue  as  to  where  to  start  the  search  to  obtain  their 
optimal  values.  I\irtherraore , the  range  over  which  these  parameters  vary  from 
flight  path  to  flight  path  gives  some  indication  of  the  sensitivity  of  a 
particular-  model  to  changes  in  flight  characteristics.  By  j>artitioning  each 
fligiit  path  into  three  segments,  one  can  also  examine  the  sensitivity  of  a 
model  to  changes  in  aircraft  motion  within  a single  flight  path.  This  leads, 
in  a natural  way,  to  considerations  of  adoptive  filters  where  parameters  such 
as  "a"  are  adjusted  during  the  course  to  take  into  account  changes  in  aircraft 
maneuvers.  Finally,  one  can  observe  the  difference  between  the  theoretical 
values  of  model  parameters  and  their  optimal  values.  If  pronounced  differences 
occur,  this  is  an  indication  that  the  assumptions  of  ergodicity  and  stationarity 
of  target  acceleration  are  not  valid.  Comparison  of  the  optimal  values  of  "a" 
for  the  hth  and  5th  order  filters  of  the  previous  section  with  the  theoretical 
values  shows  that  the  two  sets  Eigree  favorably.  However,  this  is  not  always 
the  case,  especially  when  one  considers  variations  of  the  parameters  over  each 
of  the  three  segments.  This  variation  will  be  exhibited  when  the  three  state, 
first  order  Markov  and  the  four  state,  second  order  Markov  filters  are  compared 
int  the  next  section. 
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SECTION  10 


TIffi  THREE  AND  FOUR  STATE  FILTERS 
INTRODUCTION 


The  results  of  Section  8 indicate  that  there  is  little  difference  between 
the  performance  of  four  and  five  state  filters  where  the  stochastic  portion  of 
the  acceleration  is  modeled  as  a first  order  Markov  process.  In  this  section, 
a simple  three  state  filter  is  developed  for  which  the  acceleration  is  modeled 
as  a first  order  Markov  process.  In  Section  13,  it  is  compared  with  a four 
state  filter  for  which  the  acceleration  is  modeled  as  a second  order  Markov 
process.  It  will  be  shown  that; 

a.  There  is  little  difference  in  performance  between  the  three  state 
filters  and  the  four  and  five  state  filters  of  Sections  6 and  7. 

b.  The  difference  in  performance  between  the  three  state  filter  and  the 
four  state,  second  order  Markov  filter,  is  such  that  the  use  of  the  four  state 
filter  over  the  three  state  filter  is  unwarranted. 


THE  THREE  STATE  F I LTER 


The  three  state  filter  is  based  on  the  following  model  of  the  target 
motion  along  each  of  the  three  coordinates: 


(10-1) 

xi  = X2 

(10-2) 

X2  = 

(10-3) 

x^  = -OX 

where  is  the  target  position  along  one  of  the  three  orthogonal  axes.  The 
optimal  value  of  "a"  may  be  different  for  the  x and  z axes.  The  target  state 
equations  corresponding  to  motion  along  x and  y should  be  parameterized  by 
the  same  numerical  value  of  "a"  for  reasons  discussed  in  Section  3. 


Discretization  of  these  equations  leads  to  the  matrix  equation 


(10-U) 


= F X 


G u) 


where,  by  analogy  with  the  nine  state  filter  described  in  .Section  3,  (see  also 
Appendix  B). 


Ul 


K,,  = (A)  = 


0 1 


and 


/’  A 
0 


i (1  - e-aA) 
a 


0 0 e 


•aA 


( T ) G dr  = 


i-  (e  -1)  + A/a 


- - (e-aA 
a 


- 1) 


with 


G = 


The  quantity  Ufj  is  a time  averaged  white  noise  sequence  (Equation 

2 2 

and  the  error  covariance  matrix  Q = ~ b /A. 


Before  proceeding  to  a description  of  the  four  state  filter,  it  Is 
to  motivate  the  design  of  this  filter  by  examining  the  way  in  which  the 
erat-ion  data  is  correlated. 


-18). 


useful 

accei- 
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::kction  ii 


AlfTOCOHKKIJ^TION  OF  TIIK  FACT  ACCKI^KRATl ON  DA'I'A 


In  the  filters  described  thus  far,  the  acceleration  correlation  function 
has  the  form  of  a decaying  exponential.  Although  intuition  suggests  this 
form  to  be  appropriate,  an  appreciation  for  the  form  of  the  correlation  f'unc- 
tion  for  real  flight  paths  can  be  obtained  from  the  FACT  data. 

Figure  2 through  U are  plots  of  the  acceleration  correlation  function  for 
flight  paths  1,  9,  and  12  along  each  of  the  three  coordinates.  These  plots 
were  obtained  using  the  normalized  correlation  function 

N-K 

(ll-i)  4>(k)  = [x3(n)  - X3(n)][x3(n  + k)  - X3(n  + k)l 

n=l 


strictly  speaking,  one  should  compute  the  correlation  function  over  an 
ensemble  of  flight  passes.  Since  12  hardly  constitutes  an  adequate  snmple 
size  to  analyze  ensemble  statistics,  one  uses  Equation  (ll-l)  with  the  view 
that  general  trends  in  the  shape  of  the  curves  should  provide  a clue  to  tlie 
fonii  of  the  acceleration  correlation  function.  Examination  of  Figures  2 through 
I*  indicates  that,  in  general,  the  correlation  function  exhibits  an  oscillatory 
behavior.  This  type  of  behavior  is  more  pronounced  for  the  x and  y coordinates 
than  the  z coordinate. 

In  view  of  these  considerations,  a four  state  second  order  Markov  ‘"iiter 
will  be  constructed  in  such  a way  as  to  assure  the  correlation  idinotion  for 
the  acceleration  process  to  be  an  exponentially  damped  sinusoid.  3ucli  aii 
option,  it  must  be  noted,  does  not  exist  for  the  three  state,  first  order 
Markov  filter. 
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Figure  2.  Acceleration  correlation  functions  for  flight  pass  1 
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figure  3.  Acceleration  correlation  I'unctions  Tor  flight  pass  9 
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Figure  . Acceleration  correlation  functions  for  flight  pass  12 
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SECTION  m 


THE  FOUR  STATE  FILTER 


The  four  state  filter  is  based  on  a plant  model  in  which  the  acceleration 
is  described  by  a second  order  Markov  process.  Specifically,  the  state  equa- 
tions are: 

(12-1)  xj^  = X2 

(12-2)  ^2  = 

(12-3)  x.^  = + bu 

(12-U)  xi,  = -a'^x^  + 2fixi^  + (a  - 26 )b^ 

where 

b = V 2Bo^ 

2 ,2^2 

a =3  “o 

With  this  particular  form  of  the  state  equations,  the  desired  autocorrelation 
function  is  obtained  (see  Appendix  C). 

2 

(12-^)  R(T  ) = e-^'^  cos  Wq  t 

The  0^  appearing  in  the  expression  for  L is  Just  R(0). 

The  state  transition  matrix  Fj^  can  be  obtained  by  solv  i.g  the  hom<..'geueous 
part  of  the  state  equations  as  was  done  for  the  previous  filters.  However, 
this  procedure  is  algebraically  laborious,  so  the  state  transition  matrix  is 
obtained  in  the  following  alternative  manner.  Start  with  the  ho:.'  g'  neons  stat 
equations 


- 26x^ 

In  matrix  form, 

(12-6)  * ” £ JL 


where,  by  inspection 


0 10  0 
0 0 10 


F = 


0 0 


0 


0 


-a 


-26 


The  solution  to  Equation  (12-6)  is 

r'  2 3 

(12-7)  x(t)  = e^'^x(O)  = (I  + Ft  + + It  ...)x(0) 

But  the  term  in  parenthesis  is  Just  the  desired  state  transition  matrix  'l>(t). 
(12-8)  i>(t)  = (I  + R + + . . . . ) 

In  implementing  this  equation,  only  the  first  five  terms  of  the  expression  are 
used.  Notice  that  what  is  actually  needed  is  F^  = <t(A)  where  A = 1/10  sec. 
Since  a and  6 are  generally  small  the  series  converges  rapidly. 

The  non-homogeneous  part  of  the  discrete  plant  model  is  the  term  G^'^n ’ 
where,  as  shown  in  Appendix  B 

(12-9)  Gn  = f $(t)  G d t 

J 0 

and,  by  inspection  of  Equations  (12-1)  through  (l2-h). 


(12-10)  G = 


0 

0 

b 


b(a 


- 26) 


U8 


SKCTIOW  13 


kEwUlt;; 


The  three  and  four  state  y coordinate  filters  were  optiniized  for  flight 
passes  1,  9,  and  12.  In  addition,  the  filters  were  optimized  for  each  of  three 
segments  of  a pass  (Section  9).  The  optimal  parameter  values  for  each  of  the 
filters  as  well  as  filter  performance  measured  by  RMS  values  of  errors  cy , 
cy,  cy  in  position,  velocity,  and  acceleration  estimates  respectively  are  tabu- 
lated in  Table  11.  Tables  12  through  17  exhibit  filter  performance  for  various 
parameter  values.  The  optimal  values  of  filter  pai-ameters  together  with  filter 
performance  characteristics  for  these  values  in  terms  of  RMS,  state  estimate 
errors  axe  denoted  by  an  asterisk  in  each  table. 

From  Table  11,  it  is  evident  that  there  is  significant  variation  in  the 
values  of  the  optimal  parameters  not  only  ;imong  different  flight  passes,  but 
also  among  segments  of  a single  flight  pass.  Variations  of  optimal  piu-  u:ieters 
for  different  segments  suggest  that  an  adoptive  filter  may  be  desigiied  in  juch 
a way  that  the  filter  parameters  are  adjusted  in  accordance  with  ciianges  in 
aircraft  maneuvers.  Parameter  variations  among  different  flight  paths  suggest 
that  there  may  be  scMiie  difficulty  in  choosing  a single  parameter  (two  para- 
.meters,  Wq  and  6,  in  the  case  of  the  four  state  filter)  for  wiiich  to  op'-rate 
the  filter  for  all  flight  passes.  However,  the  sensitivity  of  filter  perfonn- 
anoe  to  chaiiges  in  parameter  values,  as  exhibited  in  Tables  12  through  17,  is 
rather  mild  so  that  a decision  upon  a single  parameter  value  should  not  be  too 
difficult  to  make. 

Compai'ision  of  the  RMS  values  listed  in  Table  2 of  Section  3 oi’  tiie  four 
state  filter  and  the  RMS  values  listed  in  Table  11  of  the  thu'ee  fUid  fou;'  state 
(second  order  Markov)  filters  indicate  that  there  is  little  difference  in  per- 
formance between  these  filters.  Furthermore,  a cursory  exmaination  of  fable 
11  indicates  that  there  are  negligible  differences  in  performance  between  the 
three  and  four  state  (second  order  Markov)  filters.  On  the  basis  o''  ^ a'is 
Cumpai  ison,  we  tentatively  conclude  that  the  tiiree  sti.e  f .'er  s the 
cheapest  way  to  go  (in  tej-ms  of  computer  software)  with  .Lii.,-'  .-  no  deg!'alation 
in  performance  over  the  other  filter  designs. 
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TABLE  12 


OPTIMIZATION  OF  THREE  STATE  FILTER  (y  COMPONENT)  FOR  FLIGHT  PASS  1 


a 

RMS  (ty) 

HMS  (ep 

RJC  (*-j;) 

.02 

^>.0 

8.5 

9.2 

.01* 

1‘.9 

8.3 

8.9 

.01*5* 

1*.9 

8.3 

8.9 

'*.9 

8.3 

8.9 

.10 

5.0 

8.6 

9.0 

TABLE  13 

OPTIMIZATION 

OF  FOUR  STATE 

FILTER  (y  COMPONENT) 

FOR  FLIGHT  FASZ 

“o 

e 

RMS  iZy) 

RMS  (t^) 

Rf-IS  (ty) 

15 

.025 

1*.8 

8.3 

9.0 

175* 

.025 

1*.8 

8.P 

8.9 

2 

.0075 

1‘.9 

8.9 

‘*.2 

2 

.01 

1*.9 

.<.6 

■i.2 

O 

.025 

1*.8 

i ■ c. 

.9 

2 

.05 

l*.9 

8.  3 

8.9 

2 

.10 

5.0 

H .'f 

‘ .2 

2 

.12 

5.1 

8.8 

^.3 

2 

.11* 

5.1 

9.0 

9.1* 

2 

.16 

5.1 

9.1 

-.6 

2 

.18 

5.2 

U.i. 

o.t 

3 

.10 

5.1 

8.9 

9.5 

3 

.12 

5.1 

9.0 

9.6 

TABLE  13  (Cont) 


“*0 

6 

RMS  iZy) 

RMS  (e^) 

me  (Cy) 

.3 

.lU 

5.1 

9.2 

9.T 

.3 

.16 

5.2 

9.3 

9.9 

.3 

.18 

5.2 

9.2 

10.0 

.I4 

.10 

5.2 

9.2 

10.2 

.U 

.12 

5.2 

9.3 

10.3 

.h 

■ Ih 

5.2 

9.I4 

10.1+ 

.h 

.16 

5.2 

9.6 

10.5 

.k 

.18 

5.3 

9.6 

10.6 

.5 

.10 

5.3 

9.6 

11.3 

.5 

.12 

5.3 

9.7 

11.3 

.5 

.lU 

5.3 

9.8 

11 .1+ 

.16 

5.3 

9.9 

11.1+ 

.6 

.10 

5.1+ 

10.1 

12 .7 

.6 

.12 

5.1+ 

10.1 

12.6 

.6 

.11+ 

5.1+ 

10.2 

12.  c. 

.6 

.16 

5.1+ 

10.3 

12.6 

.6 

.18 

5.1+ 

10.3 

12.6 

TABLE  II4 

OPTIMIZATION  OF  THREE  STATE  FILTER  (y  COMI’ONENT)  FOR  FLIGHT  PASS  9 


a 

RMS  (ty) 

RMS  (Cy) 

RMS  (ty) 

1 0 
0 

7.1* 

12.6 

12.0 

.01 

6.6 

11.2 

11.1+ 

.01+ 

5.9 

9.9 

10.7 
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TABLE  IL  (Cont) 


u 

RM;.;  (cy) 

RML  (cy) 

mo  (Cy) 

Of* 

5.8 

9.9 

10.6 

i 

00 

10.1 

10.7 

TABLE  15 


OITIMIZATION  OF 

FOUR  STATE  FILTER 

(y  COMPONENT)  FOR 

FXIGHT  PASS  9 

“o 

B 

HMS  (ey) 

I^MS  (>.y) 

RMS  'c. 

o 

o 

.2 

5.8 

10.5 

11.0 

.0001 

.16 

5.8 

10.3 

10.9 

.0005 

.16 

5.8 

10.3 

10.  } 

.001 

.16 

5.8 

10.3 

10.9 

o 

o 

.16 

5.8 

10.3 

L0.9 

.03 

.16 

5.8 

10.3 

10.9 

.06 

.16 

5.8 

10.  3 

10.9 

.09 

.16 

5.8 

10.lt 

LU.9 

.10 

.16 

5.8 

10. -t 

..  -.0 

.3 

.16 

5.8 

10.6 

'i 

.6 

.16 

5.9 

11.1 

.9 

.16 

6.1 

11.9 

1 . i 

.005 

.10 

5.8 

10.  j 

Ml.  '■ 

.005* 

.05 

5.9 

9.9 

10.7 

.005 

o 

o 

T.2 

12.6 

1 •) 
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TABIJi;  16 


OFl'IMIZATION 

OF  niPEK  STATE  FILTER 

(y  COMPONENT) 

FOR  FLIGHT  PASS 

a 

RMS  Uy) 

RMS  (e^) 

RMS  (c^) 

.1 

5.2 

8.1 

6.1 

.08 

5.2 

7.7 

5.7 

5.0 

.OhU 

5.0 

6.9 

I4.8 

.01 

.6 

5.3 

3.2 

.005 

'*.5 

h.7 

2.8 

.001* 

U.i 

3.9 

2.2 

.0005 

I4.0 

3.6 

2.0 

TABLE 

17 

OPTIMIZATION 

OF  FOUR  STATE  FILTER 

(y  COMPONENT)  : 

FOR  FLIGHT  PAf'S  1 

u>o 

6 

RMS  (ty) 

RMS  (Ey) 

RMS,  (Ey) 

.7 

.165 

5.6 

9.9 

8.8 

.7 

.2 

5.6 

10.1 

9.0 

.7 

.05 

5.3 

8.1. 

6.6 

.7 

.01 

4 . 8 

6.2 

4.0 

.7 

0 

0 

h.6 

5.1* 

3.3 

.7 

.001 

h.l 

I4.I 

2.4 

.7* 

.0005 

h.Q 

3.9 

2.2 

1.5 

.0005 

U.l 

4.0 

3.3 

1.0 

.0005 

U.O 

3.9 

2.4 

.2 

.0005 

I4.2 

4.1 

2.4 

.05 

.0005 

l4.i 

4.0 

2.4 

5^ 


SECTIOII  Ik 


OKriMI'/JVTION  OK  TlffiEE  STATE  FTLTfJR  FOR  ALL  FLIGHT  PASSES 


Before  deciding  upon  a final  filter  design,  it  is  instructive  to  coinpare 
the  performance  of  the  three  and  four  state  filters  for  all  12  flight  passes 
rather  tiiar^  a selected  few.  To  this  end,  it  is  necessary  to  select  a sir.g.i.e 
value  of  "a"  for  the  three  state  filter  and  a single  set  of  values  for  u..-,  and 
6 for  tiie  four  state  filter  to  be  used  for  all  12  flight  passes.  ITirthemore , 
rather  than  compute  the  value  of  the  state  dependent  R matrix  at  every  itera- 
tion, it  is  desirable  to  replace  R with  a constant  not  ordy  for  Uie  sake  of 
computational  .simplicity,  but  also  because  it  will  be  needed  later  for  imple- 
mentatiori  of  a steady  state  filter  design. 

In  this  section,  tlie  parameter  "a"  of  the  three  state  filter  is  optimized 
over  all  flight  pusses  for  each  coordinate.  A constaiit  ^ is  also  ysen  w lici. 
oj'timizes  filter  performance.  Comparison  of  the  three  and  four  state  filters 
is  made  for  constant  ^ in  the  next  section. 

Tables  l8,  19,  and  20  exhibit  the  performance  of  the  three  stat?  y coordi- 
nate filter  for  all  flight  passes  by  using  the  full  state  dependent  rf,  as  well 
as  values  of  31  and  100  for  2.  (Recall  that  for  a single  axis,  £ is  a 1 x 1 
matrix,  i.e.,  a scalar).  The  nuinber  31  was  obtained  by  averaging  over  the  sensor 
variables  R,  0 , . (Cee  Appendix  D).  The  choice  for  "a"  is  .0"^.  N'oti:e  that, 

overall,  the  filter  sensitivity  to  R is  mild.  Furthermore,  h = 100  results  in 
better  filter  performance  than  R = 31.  Table  21  shows  the  fil'e-  performance  for 
"a"  = .1  with  R = 100.  This  results  in  a slight  overall  aeg.-adation  in  per- 
formance. However,  experimentation  with  various  values  of  "a"  for  the  x axis 
indicated  that  "a"  = .1  results  in  significant  improvement  :n  the  x •oirdinute 
filter  over  the  value  of  "a"  = .05.  This  improvement  more  ttian  c tu  euaHtes 
for  the  slight  degradation  in  performance  of  the  y filter  for  " =-  .1  r/er 

"a"  = .05.  Thus,  the  value  of  "a"  is  chosen  as  .1  for  both  M;e  x ar:.!  y c jor- 
dinate  I'iiters.  The  performance  of  the  x coordinate  filter  sliiwi,  j.;. 

Table  22. 

Although  there  is  no  a-priori  reason  I'or  the  optimal  vai.ie  of  "a"  ;'o" 
the  z filter  to  be  the  same  as  for  the  x ani  y filters,  the  res'.ltr.  of 
Tables  23,  2k  and  25  indicate  that  the  value  of  .1  >uid  " i (Uso  optimal 
for  the  z filter. 

The  performance  of  the  three  state  filter  is  illustrated  c"aphi  il  .y  In 
Figures  5a  through  5c  in  which  the  x component  of  torr'd  p ritioi  , ’/•>  oci'y 
and  acceleration  is  plotted  against  time,  togetiier  wltli  the  I'n'ered  fiivdes 
of  these  quantities.  This  is  done  for  flight  puss  i. 

The  value  of  "a"  which  parameterizes  tlie  three  state  filler  is  .1. 

Figures  6a  through  6c  are  the  corresponding  error  curves.  Of  particu'ai- 
interest  is  Figiire  5<'  in  which  the  true  and  filtered  acceler  ation  c nai  s :u-<- 
contrasted.  These  curves  typify  the  lag  associated  with  the  filteiasi  arcflcr- 
ation  estimates.  The  degree  to  which  tfie  filtered  accel er.at ion  lags  betiind 
the  true  acceleration  is  generally  influenced  by  the  intensity  of  the  white 
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TABLE  l8 


PERFORMANCE  OF  3 STATE 

, y COORDINATE  FILTER 

FOR  "a"  = 

. 05 , R = STATE  DEPENDENT 

Flight  Pass 

RMS  £y 

RMS 

RMS  Cy 

1 

U.2 

8.2 

9.2 

2 

8.6 

7.U 

3 

^.9 

8.8 

9.7 

k 

U.l 

8.2 

9.7 

5 

5.2 

9.U 

9.8 

6 

9.U 

9.8 

T 

l*.8 

8.9 

9.7 

8 

9.1 

13.2 

9 

5.7 

10.6 

11.6 

10 

5.5 

9.6 

10.3 

11 

5.7 

10.0 

10.6 

12 

5.7 

9.0 

6.9 

Average 

5.0 

TABLE  19 

9.2 

9.8 

PERFORMAiJCE  OF  3 

STATE,  y COORDINATE  FILTER  FOR 

"a"  = .05,  R = 31 

Flight  Pass 

RMl-'y  ty 

RMS  ey 

RMS  £y 

1 

h.2 

8.U 

9.U 

2 

5.1 

9.3 

8.3 

3 

5.0 

9.2 

10.2 

L 

U.2 

8.U 

9.9 

5 

?.u 

9.9 

10.5 

6 

U.9 

9.5 

10.2 
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TABLai;  19  (Cunt) 


Flight  Pass 

RMS  Ey 

RMS  Ey 

RMil  Ey 

7 

l*.8 

9.0 

9.9 

8 

13.9 

9 

9.9 

11.2 

12.2 

10 

9.7 

10.3 

11.2 

11 

9.7 

10.8 

11.  u 

12 

9.9 

10.2 

8.6 

Average 

9.1 

TABLE  20 

9.6 

10.  u 

PERFOKMAUCE  OF  3 STATE, 

y COORDINATE 

FILTER  FOR  "a"  = 

.09,  R = 

Flight  Pass 

RM!1  ty 

RMS  Ey 

. 1 

1 

3.9 

7.'* 

..  . 

2 

U.8 

7.1. 

. j 

3 

^.9 

8.6 

0.8 

li 

U.L 

7.8 

3.  > 

9 

9.2 

8.8 

J- '■ 

6 

1^.9 

8.1 

3.0 

7 

L . 6 

8.2 

' ' . ? 

8 

h.L 

10,  J 

iL.t 

9 

9.8 

10.). 

1 .;■> 

10 

9.‘* 

0.)* 

10,6 

11 

9.7 

9.8 

10.3 

12 

9.6 

8.0 

9.9 

Average 

i*.9 

8.7 

9.U 

TABLE  21 


I'KKIXJHMABCE  OF 

3 E'l’ATK,  y COORDINATE 

FILTER  FOR  "a"  = 

.1,  R = 

Faus 

rm;  ; Cy 

RMS  r.y 

RMS  e" 

1 

h.O 

7.7 

8.6 

2 

'4.9 

8.2 

6.7 

3 

'4.9 

8.6 

9.14 

h 

'4.1 

7.9 

9.2 

5 

5.2 

9.1 

9.3 

6 

'4.7 

8.5 

8.9 

T 

'4.7 

8.3 

9.2 

8 

'4.14 

9.2 

13.3 

9 

5.7 

10.5 

11.3 

10 

5.5 

9.5 

10.3 

11 

5.7 

10.0 

10.3 

12 

5.7 

8.9 

6 .6 

Average 

5.0 

8.9 

9.14 

TABLE  22 

Fll^FORMANCE  OF 

3 STATE,  X COORDINATE 

FILTER  FOR  "a"  = 

.1,  R = ] 

Flight  Bass 

RMS 

RMi-,  e; 

RMS  t" 

1 

2.8 

6.3 

8.9 

2 

3.2 

6.8 

9.5 

3 

3.2 

9.5 

15.2 

U 

3.0 

6.6 

9.6 

5 

2.1* 

6.2 

9.5 

6 

3.3 

9.8 

15.7 

^3 


TABLE  22  (Cent) 


Flight  Pass 

RMS  Ex 

HR’>  E- 
X 

m:  f.- 

r 

7 

3.0 

7.5 

10.9 

8 

3.3 

9.2 

14.0 

9 

3.3 

8.3 

1^.8 

10 

3.9 

9.8 

15.1 

11 

it.O 

10.6 

16. 1 

12 

3.7 

6.2 

5.6 

Average 

3.7 

TABLE  23 

8.1 

1. 

I'ERFORMAIJCE  OF  3 

STATE  z COORDINATE  FILTER  FOR  "a"  = 

II 

0 

Flight  Pass 

RM3  t 

z 

liME  E- 
z 

mr  f •• 

1 

I4.0 

8.6 

e.‘. 

2 

5.9 

12.8 

j i.'i 

3 

5.1 

8.5 

>■ 

It 

it.t 

7.6 

t 

5 

L.O 

7.5 

. 1 

6 

5.6 

12.1 

7 

5.3 

10.  V 

'1.1 

8 

5.f- 

10.  V 

1 . . 

9 

5.7 

13. 

15.  ( 

10 

5.5 

IP.  9 

.8 

11 

5.I4 

12.5 

13.9 

12 

3.7 

0.6 

5.8 

Average 

5.1 

10.3 

11.1 
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TAB1>E  :>h 


I'KRFfJRMMCK  OF  3 OTATE 

, z COOROINATO 

FILTER  FOR  "a"  = 

.05,  R = 100 

Fiiglit  Fuss 

RMS  Ej, 

RM  S 

RMS  E>; 

1 

7.7 

7.8 

2 

9.5 

11.7 

3 

^.7 

7.9 

7.7 

U 

i*.2 

6.9 

7.6 

5 

l*.l 

7.0 

8.2 

6 

l4.l4 

9.3 

12.0 

7 

U.l* 

8.9 

10.3 

8 

4.8 

9.5 

10.7 

9 

4.1 

9.8 

13.4 

10 

4.0 

9.2 

12.3 

11 

4.1 

9.4 

12.0 

12 

4.0 

7.0 

6.1 

Average 

4.3 

TABLE  25 

8.5 

10.0 

FERFORMANCE  OF  3 STATE, 

z COORLINATE  i 

FILTER  FOR  "a"  = , 

.1 , R = 100 

Flight  Fass 

RMS  tj. 

RMS  E^ 

RMS  t - 

1 

4.6 

8.0 

7.9 

2 

4.2 

8.8 

10.9 

3 

4.7 

8.2 

7.9 

U 

4.4 

7.2 

7.7 

4.2 

7.3 

8.2 

6 

4.2 

8.7 

11.4 
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TABLE  21  (Cont) 


Fiirflit  FafJS  ftME  l HMH  c‘  RM.'J  ( ' ' 

a.  L ± 


7 

U.2 

8.7 

10.1 

8 

h.l 

9.U 

10.8 

9 

3.7 

9.0 

12.7 

10 

3.T 

8.5 

11. t 

11 

h.O 

8.8 

11.3 

12 

h.l 

7.5 

6.5 

Average 

U.2 

13.8 

9.8 

noise  driving  the  acceleration  process  as  well  as  the  number  of  aeri 
needed  to  obtain  the  acceleration  estimate  from  the  raw  sensor  data 
this  case,  two). 

In  summary,  we  achieved  a rather  simple  filter  design  ir.  wnict 
identical  and  independent  filters  operate  for  each  coordinate  vith  a 
R of  100  and  the  parameter  "a"  having  a value  of  .1. 


vai.1  ves 


tf  -ee 

t UiS'ant 
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Figure  5-  Filtered  and  true  position,  velocity,  and  acceleration 
profiles  along  x for  flight  pass  1 
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SECTION  15 


COMPARISON  OF  THE  THREE  AND  FOUR  STATE  FILTERS 


In  this  section,  a final  comparison  of  the  three  and  four  state  filters 
is  made.  With  the  view  that  a decision  based  on  12  flight  passes  is  better 
than  one  based  on  three,  the  determination  of  the  more  desireable  filter 
design  is  made  using  all  12  available  flight  passes.  Again,  as  in  the  case 
of  the  three  state  filter,  a choice  is  made  for  parameters  Wq  and  B as  well 
as  for  R_.  With  wq  ■ *1  oJid  6 * .03,  Tables  26,  27,  and  28  indicate  that  the 
appropriate  choice  for  R is  again  lOO.  Comparing  Tables  21  o,f  Section  li<  with 
Table  28,  we  see  that  the  performance  of  the  two  filters  is  virtually  identical. 
Thus,  the  choice  of  one  filter  over  another  reduces  to  a choice  between  a 
simple  filter  design  and  a slightly  more  complex  one.  On  the  basis  of  these 
arguments,  as  well  as  the  results  of  the  foregoing  sections,  we  conclude  that 
the  three  state  filter  offers  the  best  features  for  implementation  in  a fire 
control  system. 


TABLE  26 


PERFORMANCE  OF 

1*  STATE, 

y 

COORDINATE  FILTER 

FOR 

UiQ  ■ • 1 * 

6 ■ .03, 

R 

» STATE  DEPENDENT 

Flight  Pass 

RMS  £y 

RMS  Cy 

RMS  Cy 

1 

k.l 

8.0 

9.1 

2 

h.9 

8.2 

7.1 

3 

5.0 

8.8 

10.1 

U 

I4.I 

8.1 

9.6 

5 

5.2 

9.2 

9.8 

6 

4.8 

9.0 

9.7 

7 

4.8 

8.7 

9.9 

8 

4.5 

9.4 

13.9 

9 

5.7 

10.6 

11.7 

10 

5.5 

9.5 

10.7 

11 

5.6 

10.0 

11.0 

12 

5.7 

8.6 

6.5 

Average 

5.0 

9.0 

9.9 

6U 


'I'AhLiC  i‘Y 


i’Khkow-iancf; 

OF' 

(Do 

't  ::tatk,  y 

= .1,  h = 

COORDINATE  FII.TER 
.01,  R = 11 

FOR 

Flight  Pass 

HM.;  ty 

RMS  Cy 

RMS  ty 

i 

l*.l 

8.1 

9.3 

2 

5.1 

8.8 

7.9 

3 

5.1 

9.2 

10.6 

k 

1.2 

8.I4 

9.8 

5 

5.3 

9.7 

10. 14 

6 

J..8 

9.1 

9.9 

7 

)4.8 

8.8 

10.0 

8 

14.6 

9.7 

11..3 

9 

5.9 

11.1 

12.3 

10 

5.7 

10.2 

11.14 

11 

5.7 

10.7 

11 

12 

5.8 

9.7 

8.- 

Average 

5.1 

9.5 

10 . s 

TABLE 

28 

PKRFOPMAiiCE 

OF 

Wq 

I4  r:TATE,  y 
= .1,  fj  = . 

COORDINATE  FILTEB 
03 , R = 100 

FOR 

Flight  Pass 

RMS  £y 

RM;'  ty 

PJ-r  ty 

1 

3.9 

7.5 

8.5 

2 

1^.7 

7.2 

5.8 

•} 

5.0 

9.1 

10. 14 

)4 

I4.2 

7.9 

8.9 
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GECTlOfI  16 


STEADY  STATE  FILTER 


The  steady  state  filter  offers  the  simplest  filter  desiKii  considered  thus- 
I'ar.  This  filter  is  implemented  by  replacing,  tiie  elements  of  the  f'ain  matrix 
With  its  steady  state  values,  i’or  the  three  state  filter,  the  gain  K is  a 
tiiree  component  column  vector.  Its  steaiiy  state  value  is  determined  by  run- 
ning the  filter  over  an  entire  fligiit  path.  For  the  three  .state  filter  with 
"a"  = .1  and  R = 100,  the  steady  state  gains  are  Kp  = .27,  Ky  = .3^,  ~ 

Tables  29,  30,  31  illustrate  the  performance  of  the  steady  state  filter. 
Table  32  is  a composit  of  Tables  29  through  31  where  the  Rfili  errors  along  x, 
y,  and  z are  combined  to  give  tlie  total  position,  velocity,  and  acceleration 
RMf  errors  in  the  state  estimates.  Table  33  is  the  analogue  of  Table  32  for 
the  non-steady  state  filter.  Comparison  of  Table  32  with  Table  33  ^or  Tables 
29  tiirough  31  with  Tables  21,  22,  and  29),  indicate  that  the  steady  .state 
filter  performs  almost  as  well  as  the  non-steady  state  design.  I.udeed  , the 
difference  in  performance  of  the  two  filters  may  be  attributed  to  the  transient 
response  of  the  time  varying  gains  in  the  non-stealy  state  filte*-. 


TABLE  29 

PERFORMAWCE  OF  3 CTATE,  x COORDINATE  STEADY  STATE  FILTET. 


Flight  Pass 

RMS  e 

X 

1 

2.8 

2 

3.2 

3 

3.3 

L 

3.0 

5 

2.U 

6 

3.5 

7 

3.2 

8 

3.5 

9 

3.3 

10 

1*.0 

11 

U.O 

PliS  t - RMS  e" 

X y. 


7.0 

9.7 

7.3 

10.0 

9.8 

15.: 

6.9 

9.3 

6.7 

9.5 

10.5 

16.1 

8.1 

11.5 

9 . 5 

ll4.t 

9.3 

li‘  .7 

10. L 

15.5 

11.2 

17.0 
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TABLE  29  (Cont) 


Flight  Pass 

RMS 

RMS  Cx 

RMS  Ey 

12 

3.7 

7.2 

7.0 

Average 

3.3 

8.7 

12.5 

TABLE  30 

PERFORMANCE  OF  3 

STATE  y COORDINATE 

: STEADY 

STATE  FILTE’R 

Flight  Pass 

RMS 

RMS 

RMS  Ey 

1 

U.O 

8.5 

10.2 

2 

>*.9 

9.3 

9.h 

3 

^.9 

9.7 

11. h 

U 

i^.l 

8.9 

11.3 

5 

5.2 

10.2 

11.9 

6 

1».6 

11.5 

11.6 

7 

i*.6 

9.0 

11.0 

8 

E.i* 

10.0 

15.0 

9 

5.7 

11.  L 

13.2 

10 

5.5 

10.1 

11.9 

11 

5.7 

10.6 

11.9 

12 

5.7 

9.7 

8.9 

Average 

»*.9 

9.9 

11.5 

Figure  T is  a plot  of  Kp,  iCy, , and  K;,  for  the  three  state,  y component 
filter  with  "a"  = .05.  (This  is  the  optimal  value  of  "a"  for  flight  pass  1 for 
which  these  plots  were  made).  Tlie  conclusion  that  can  be  drawn  from  these  curves 
is  significant.  Namely,  that  after  about  3 seconds,  during  which  the  gains 
settle  to  their  steady  state  values,  the  performance  of  the  two  filters  is  in 
essence  identical. 


TABU:;  J1 


PKW’ORMANCE  OF  3 OTATE  z COORDINATE  OTEADY  STATE  FILTER 


Flight  Pass 

RMi'.  e 2 

RMS  Li 

RMS  C2 

1 

1*  .6 

8.0 

8.5 

2 

h.2 

8.6 

10.9 

3 

J^.7 

8.1 

8.6 

L 

U.I4 

7.3 

8.5 

5 

h.2 

7.1 

8.4 

6 

h.2 

8.7 

12.0 

7 

h.2 

8.6 

10.7 

8 

h.l 

9.9 

11.8 

9 

3.7 

8.9 

12.7 

10 

3.7 

8.4 

11 . 6 

11 

u.o 

8.8 

11.4 

12 

!+.0 

7.2 

tj . Ij 

Average 

4.2 

8.3 

10. 1 

TABLE  32 

TCn’AL  RMS 

ERRORS  FOR  3 STATE, 

STEADY  STATE 

FILTERS 

Flight  Pass 

RMy  ^pos 

RMS  ua, 

1 

6.7 

13.6 

16.8 

2 

7.2 

l4 .6 

17.6 

3 

7.5 

16.0 

20.8 

I4 

6.7 

13.4 

17.2 

5 

7.1 

14.1 

17.4 
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TABLE  32  (Cont) 


Flight  Pass 

RMG  Epos 

RMS  cvel 

RMS  Eacc 

6 

7.1 

17.9 

23.2 

7 

7.0 

11+.9 

19.2 

8 

7.2 

l6.8 

23.8 

9 

7.6 

17.2 

23.5 

10 

7.7 

16.8 

22.7 

11 

8.0 

17.7 

23.6 

12 

7.9 

lU.l 

13.0 

Average 

7.3 

15.6 

19.9 

TABLE  33 

TOTAL  RML 

ERRORS  ’OR  3 STATE 

FILTERS  WITH  R = 

100 

Flight  Pass 

^pos 

RMS  Eyei 

RM»j  c 

1 

6.7 

12.8 

ih.i 

2 

7.2 

13.8 

15.9 

3 

7.5 

15.2 

19.6 

h 

6.7 

12.6 

15. 

5 

7.1 

13.2 

15.6 

6 

7.1 

15.7 

21.3 

7 

7.0 

lU.2 

17.5 

8 

7.2 

16.1 

22.2 

9 

7.6 

l6.U 

21.9 

10 

7.7 

l6.1 

21.6 

11 

8.0 

17.0 

22.  »4 
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table  33  (Cont) 


Flight  Pass 

Epos 

RMP  £\rel 

HMtj  ^acc 

12 

8.0 

13.2 

10.8 

Average 

7.3 

li*.7 

i8.3 

Figures  8 through  13  are  typical  error  curves  for  both  filters.  As 
expected  there  is  little  difference  between  the  two  sets  of  curves.  With  the 
exception  of  occasional  peaked  values  after  settling  has  occured,  the  more 
sizeable  errors  occur  early  in  time. 
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TIME  (SECONDSI 


er  for  state  es 


SECTION  17 


IMPROVED  SENSOR 


Thus  far,  filter  perfonaance  was  Judged  relative  to  a sensor  which  is 
characterized  by  a standard  deviation  in  range  of  iOm  and  a 1b<  standard  devia- 
tion in  both  azimuth  and  elevation  measurements.  In  this  section,  the  increase 
in  estimation  accuracy  achieved  when  a higher  quality  sensor  is  employed  is 
investigated.  Here,  the  sensor  is  assumed  to  have  a standard  deviation  in 
range  of  5m,  and  a l/2ji  standard  deviation  in  both  azimuth  and  elevation. 

ITius,  the  increase  in  sensor  accuracy  is  twofold. 

The  sensor  model  must  now  be  modified  to  accommodate  the  change  in  sensor 
accuracy.  This  is  accomplished  by  changing  the  value  of  R from  100  to  25. 

Table  3^  lists  the  total  RME  position,  velocity,  and  acceleration  estima- 
tion errors  over  all  three  coordinate  axes,  for  all  12  flight  passes.  Tiie 
results  indicate  that  an  improvement  in  the  raw  sensor  data  does  not  result 
in  a corresponding  improvement  in  filtered  state  estimates.  Whereas  the  raw 
sensor  measurements  are  increased  in  accuracy  by  a factor  of  two,  the  average 
improvement  in  the  position  estimate  is  1.9  to  1,  while  the  velocity  and 
acceleration  estimates  improve  by  factors  of  3 to  2 and  6 to  5 respectively. 

In  conclusion,  doubling  the  sensor  accuracy  does  not  double  the  state 
estimation  accuracy,  and  the  relative  improvement  in  state  estimation  de- 
creases as  one  goes  from  velocity  to  acceleration  estimates. 


TABLE  3i< 


TOTAL  KMC  ERRORS 

FOR  3 STATE 

FILTER  WITH  IMl’ROVED 

SENSOR 

Plight  Pass 

R1>1S  Epos 

RMS  EygX 

RiMS  E^, 

1 

3.6 

8.7 

12.6 

2 

3.9 

9.1 

13.3 

3 

L.O 

10.0 

13.1 

h 

3.6 

9.6 

13. U 

5 

3.9 

8.9 

13.7 

6 

3.9 

10. u 

18.1 

7 

3.7 

0.3 

lU.7 

8 

3.9 

10.8 

19.1 
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TABLK  (Corit) 


FJ.i*;ht  Fasa 

KMS 

W4S 

RMIl  E^cc 

9 

U.l 

10.8 

18.5 

10 

U.l 

10.6 

18.1 

11 

i4.1 

11.1 

18.7 

12 

I4.2 

8.9 

15.2 

Average 

3.9 

9.9 

15.2 
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SECTION  18 


RATE  AIDED  FILTER 


A:’  a rule,  the  Hccuracy  of  state  estimation  increases  witii  an  increase 
in  tiie  number  of  independent  sensor  measur'-ments . I-Tesent  day  fire  control 
concepts  as  well  as  operational  systems  such  as  GLAADS  make  use  of  rate  data 
for  state  estimation.  However,  the  sensor  measurements  are  not  necessarily 
all  independent.  Range  rate,  for  example,  is  usually  derived  by  processing 
radar  return  signals.  The  manner  of  processing  is  also  germane  to  the  radar 
unit.  The  increase  in  filter  performance  given  rate  inputs  for  a hypothetical 
position  and  rate  sensor  is  determined  in  this  section.  The  sensor  model  is 
hypothetical  because  sufficient  data  is,  at  present,  lacking  for  the  construc- 
tion of  an  accurate  sensor  model.  The  sensor  is  therefore  modeled  as  having 
position  and  rate  measurements  which  are  uncorrelated  with  each  other. 

The  position  measurements  are  assumed  to  be  of  the  same  quality  as  in  ear 
earlier  sections.  That  is,  the  standard  deviation  of  the  range  error  is  10m 
while  the  arigular  errors  have  a standard  deviation  of  iM.  Range  rate  error 
is  assumed  to  have  zero  mean  and  standard  deviation  of  5 m/sec,  while  angular 
rate  errors  are  characterized  by  a standard  deviation  of  l/2jii/sec  with  zero 
mean . 


The  modification  in  the  three  state  filter  with  these  additional  measure- 
ments is  minor.  The  H matrix  i.a  the  sensor  model  Z = Hx  + Dv  is  modified  to 


(18-1) 


] 0 

H = 

. 0 1 


0 

0 J 


whereas  v_  is  now  a two  element  column  vector, 

^1 


(18-2)  V = 


As  a consequence,  the  error  covariance  matrix  for  the  observation  model  is  a 
2x2  matrix  with  (Appendix  D) 


(18-3)  Rj^j^  = cos^^  + cos^e  siri2^ 


2 . 2.  . 2 1 ^ 2 . 2.  2 
+ 0^  Sin  0 Sin  «rl  + sin  0 cos  'f 


-22  2 22  2 
(18-I*)  R^2  " = R R (o^  sin  0 sin  + Ug  cos  0 cos  ^ 

2 2 2 2 '22  2 
+ Og  cos  0 sin  >g)  - 0o^  R sin0  cos0  sin  •fi 


- R Og  cos  0 sin>^  cosv’ 


8l 


.2  2 22  2 22  2 
(l8-5)  8^2  = (R  + <Jp)  [o^  sin  0 sin  cos  0 cos  ^ 

2 2 2 2 2 2 2 
+ Og  cos  0 sin  f]  + sin  0 cos 

2.2  2 22  2 22  2 

+ R (ij  + Cg  ) [a ^ cos  0 sin  + Og  sin  0 cos 

22  2 2,  22  2 2 

+ Og  Sin  0 sin  + R Og  cos  0 cos 

+ R^  (v"^  + 0^^)  sin^0  cos^'f  + o ^ cos^0  sin^'^’ 

^ 2 2 2^  2 1 „2  2 . 2„  . 2 

+ Og  'J^  COS  0 cos  i^J  + R sin  0 sin  •f 

* * 2 2 * 2 

+ 2 R R 0 sin  0 coss^  + 0 a.,  sinO  cos0  sin'^ 

'r  't' 

2-  2„  , . 

- Og  cos  0 cos>^;  sim;: 


for  the  X coordinate  filter.  The  elements  of  the  R_ matrix  for  the  y coordinate 
filter  are  obtained  by  simply  replacing  by  90°  - ^ in  the  above  expressions. 

For  the  z coordinate  filter,  the  elements  of  R are 


(18-6) 

«11 

o2  2 . 2„  2 2„ 

= R 0^.  Sin  0 + cos  0 

0 H 

( 18-7 ) 

2 2 

Ri2 

= Rp^  = R R Og  sin  0 

(18-8) 

R22 

= R^  Og^  sin^0  + r2  (0^  + Og^)  Og^  cos^0  + 0^  0^  sin^0 

• 2 2 2 2 2 • • 2 
+ (R  + 0-)  o sin  0 + o-  cos  0 + 2 R R 0 a,  sin0  cos0 
n y n y 


Rather  than  use  the  state  dependent  R^ matrices  above,  which  are  after  all, 
rather  complicated,  the  elements  of  ^ will  be  replaced  by  constant  values. 

This  procedure,  as  was  demonstrated  earlier,  works  quite  well  for  the  "posi- 
tion only"  filter.  Tiie  validity  of  tiiis  approach  for  the  rate  aided  filter  was 
nevertheless  confirmed  by  implementing  the  y coordinate  filter  with  the  state 
dependent  The  results  confirmed  the  suspicion  that  there  is  a negligible 
difference  in  performance  between  the  two  filters.  The  constant  R for  all 
three  filters  is  chosen  to  be 


(18-9)  R = 


0 

2t> 
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Tables  35  and  36  illustrate  the  performance  of  the  rate  aided  and  the 
steady  state  rate  aided  filters  respectively.  As  seen  from  these  tables, 
both  filters  perform  quite  well  with  marginal  differences  in  performance. 

Comjiai’ing  tlie  results  of  these  tables  with  the  results  of  Tables  33  and 
3><  for  the  "position  only"  filter  and  the  filter  operating  with  an  improved 
sensor,  tiie  following  conclusions  can  be  drawn:  On  the  average 

1)  the  addition  of  rate  information  to  the  observations,  i.e.,  R,  0,  v’, 
without  changing  the  quality  of  the  position  measurements  results  in  an  over- 
all increase  in  state  estimation  accuracy  by  a factor  of  2.3  to  1 in  position, 
U to  1 in  velocity,  and  9 to  5 in  acceleration. 


TABLE  35 

TOTAL  RMS  ERRORS  FOR  3 STATE,  RATE  AIDED  FILTERS 


Flight  Pass  RMS  Epos 


1 

3.0 

2 

3.2 

3 

3.2 

U 

2.8 

5 

3.2 

6 

3.0 

7 

3.0 

8 

3.2 

9 

3.2 

10 

3.6 

11 

3.5 

12 

3.T 

Average 

3.2 

RMS 

PuMS  t 

^acc 

3.3 

7.9 

3.6 

9.0 

3.7 

10.3 

3.5 

8.9 

3.6 

8.9 

3.7 

10.6 

3.3 

9.0 

3.8 

11.3 

3-8 

11. 

I4.0 

11.3 

h.2 

11.5 

J4.I 

8.3 

3.7 

9.9 
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TABLE  36 


TOTAL  RMS  ERRORS  FOR  3 STATE,  RATE  AIDED  STEADY  STATE  FILTER:’ 


ght  I'as:; 

'-pos 

rm:;  ..ye I 

1 

3.5 

3.3 

7.7 

2 

3.7 

3.7 

8.9 

3 

3.9 

3.7 

10.2 

k 

3.3 

3.5 

8.9 

5 

3.8 

3.6 

8.8 

6 

3.6 

3.7 

10.6 

7 

3.5 

3.3 

8.9 

8 

3.5 

3.7 

11.2 

9 

h.O 

3.9 

11.3 

10 

h.l 

:*.o 

11.2 

11 

k.k 

U.2 

11. U 

12 

i*.6 

i..i 

8.0 

Average 

3.8 

3.7 

9.8 

2)  doublitig  the  accuracy  of  a position  only  filter  (by  reducing  the  R, 

0 , a values  by  1/2),  does  not  increase  state  estimation  performance  as  much 
as  does  the  eiddition  of  rate  information.  That  is,  the  rate  aided  sensor  pro- 
vides better  state  estimates  than  the  improved  position  only  sensor.  These 
estimates  are  more  accurate  by  a factor  of  6 to  5 in  position,  2.7  to  1 in 
velocity,  and  3 to  2 in  acceleration. 

The  indications  are,  then,  that  if  one  wishes  to  improve  the  quality  of 
target  state  estimates,  the  effort  is  better  spent  in  building  a rate  sensor 
rather  than  an  improved  position  only  sensor. 
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SECTION  19 


CORRELATED  NOISE  SENSOR 


Wliite  noise  is  a mathematical  fiction.  It  does  not  occur  in  reality 
because  real  events  are,  in  fact,  time  correlated  and  do  not  take  on  values 
between  plus  and  minus  infinity  over  arbitrarily  small  time  intervals.  Never- 
theless, the  concept  of  white  noise  is  useful  because,  at  least  in  its  dis- 
critized  form,  it  is  often  not  a bad  approximation  to  reality.  Furthermore, 
it  is  often  used  as  a driving  function  for  modeling  a stochastic  process  which 
is  characterized  by  time  correlated  events.  An  appropriate  model  for  such  a 
process,  therefore,  requires  some  knowledge  of  the  correlation  time. 

In  this  section,  we  simulate  the  sensor  noise  for  each  c»f  the  three  posi- 
tion measurements  as  a first  order  Markov  process  characterized  by  a correla- 
tion time  of  .1  sec.  The  filter  equations  will,  however,  remain  unchanged. 
That  is,  the  filter  still  "thinks"  that  the  sensor  noise  is  uncorrelated. 
Whatever  the  filter  performance  in  this  case,  it  should  improve  if  one 
incorporates  into  the  filter  equations  tlie  appropriate  sensor  model  for  which 
the  sensor  errors  are  time  correlated. 

The  correlated  sensor  errors  are  modeled  as  a first  order  Markov  process 

t>y 


X = -ax  + bu) 

where  w is  white  noise.  As  seen  in  Section  10,  the  solution  for  the  discrete 
form  is 


^n+I 


(A)x„  + b 


(t )w  dt 


where 


-at 


so 


e 


-at 


Thus , 

(19-1)  Xfj+i  = -{1  - 

where  — is  the  correlation  time  and  b is  the  intensity  of  the  white  noise 
a 

sequence.  The  same  standard  deivation  values  are  assumed  as  were  used  through- 
out most  of  the  report.  That  is,  a 10m  standard  deviation  in  range  error  and 
Igi  standard  deviation  in  the  azimuth  and  elevation  errors. 


85 


Kquation  (19-1)  is  used  to  generate  the  sequence  of  measurement  errors  in 
the  simulation.  The  results  of  the  simultation  for  all  12  flight  passes  using 
the  now  standard  three  state  filters  is  provided  in  Table  37-  The  results  are 
remai'kable  but  not  too  surprising.  Filtered  state  estimates  are  considerably 
improved  when  the  sensor  noise  is  correlated.  The  RM?  errors  in  position  drop, 
on  the  average,  by  53^,  the  velocity  RMl'  error  decreases  by  '^2%,  and  the 
acceleration  RMS  error  decreases  by  19^-  The  reason  for  this  improvement  is 
that  a correlated  sequence  is,  in  a gross  sort  of  way,  a smoother  function  of 
time  than  ari  uncorrelated  time  sequence  which  means  that  it  is  easier  for  the 
filter  to  "learn"  a correlated  process  than  an  uncorrelated  one. 

I’igures  lUa,  lUb,  and  l4c  exhibit  typical  ptjsition,  velocity  and  acceler- 
ation profiles  along  the  y coordinate  for  flight  pass  1.  It  is  evident  from 
Figure  lUc  Uiat  there  is  a characteristic  i;ig  in  the  acceleration  estimate 
which  probably  accounts  for  a significant  portion  of  tiie  total  RMH  accelera- 
tion error.  The  corresponding  error  curves  are  contained  in  Figures  15a- 
15b  and  15c. 


TABLE  37 

TOTAL  RMS  ERRORS  FOR  3 STATE  FILTERS  WITH  CORREIJITED  SEIISOR  NOISE  INPUI’S 
Flight  Pass  RMS  RMS  RMS 


3.0 

7.5 

11.9 

2 

3.3 

7.6 

12.1* 

3 

3.3 

8.9 

l6.0 

1* 

3.2 

7.i^ 

12.8 

5 

3.2 

7.5 

12.8 

6 

3.5 

9.6 

17.7 

7 

3.3 

8.14 

ll*.l 

8 

3.6 

JO.O 

i8.7 

9 

3.6 

9.9 

18.1 

10 

3.6 

9.7 

17.9 

11 

3.6 

10.2 

18.5 

12 

3.5 

5.3 

6.7 

Average 

3.5 

5.3 

6.7 
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ACCELERATION  (M/SEC2)  VELOCITY  (MET/SEC)  POSITION  IMETERS) 


000  3600  7200  10800  14400  19000  21600  25200  28800  32400  36000 


QOO  3600  7200  10800  14400  18000  21600  25200  28800  32400  36000 


000  3600  7200  10800  14400  18000  21600  25200  28800  32400  36000 

TM(  1 SECI 


Figure  1^.  Filtered  and  true  position,  velocity 
profiles  along  y for  flight  pass  1 


o 


TM(  1 n SEC) 


?’igure  15.  State  estimation  error  curves  for  y component  of 
target  position,  velocity,  and  acceleration  for 
flight  puss  1 


88 


SECTION  20 


SIMUUTION  OF  THE  NINE  STATE  FILTER 


In  S<.‘ctiori  3,  we  dfjU'.Tibed  the  9 state  filter,  a paradi/.vn  upon  which  sub- 
r,e,|ar-[it.  nubept  itnal  filter  designs  were  U-ised . This  filter  couples  the  state 
erl i mat  Ion  errors  bi'tween  each  of  the  three  coordinates  whereas  the  subsequent 
filters  do  not.  One  therefore  expects  improved  performance  of  the  9 state 
filter  over  the  < state  filters.  Solution  for  the  state  estimates  using  this 
filter,  however,  involves  more  computation  because  of  the  need  to  do  matrix 
inversion  at  eacii  iteration.  In  contrast  no  matrix  inversion  is  required  for 
the  solution  of  the  state  estimates  when  using  the  suboptimal  design.  The 
motivation  for  investigating  suboptimal  filter  designs  was  precisely  this  need 
to  minimize  the  number  of  computations  required  for  the  solution  of  the  state 
estimates. 

The  penalty  incurred  by  implementing  the  3 state  filter  over  the  9 state 
filter  is  investigated  in  this  section.  As  seen  in  Section  3,  the  9 state  filter 
is  parameterized  by  the  some  quantities  as  the  3 state  filter.  The  parameters 
of  interest  are  the  quantities  a^ , ag , aq  whose  optimal  values  are  = ap  = 
a3  = .1.  In  implementing  this  filter,  the  state  dependent  ^matrix  is  used. 
Results  of  the  simulation  for  all  12  fJig.ht  passes  .-u-e  listed  in  Table  38. 
Comparison  of  these  results  with  those  of  Table  33  for  the  3 state  filter 
indicates  that,  on  the  average,  the  9 state  filter  results  in  a 2.1%  decrease 
in  position  KMC  error,  a 10.9^  decrease  in  tiie  velocity  RM;'.  '-rror,  and  a l6.h% 
decrease  in  the  acceleration  RMS  error.  These  results  are  eticouraging  because 
they  indicate  that  the  improvement  in  state  estimates  is  marginal.  It  is  there- 
fore reasonable'  to  assert  that  the  ease  of  implementation  of  the  3 state  filter 
outweighs  the  marginal  gain  in  accuracy  incurred  with  use  of  the  9 state  design. 
The  conclusion,  then,  is  that  the  3 state  filter  derived  in  t.his  report  is  most 
suitable  for  implementation  in  a fire  control  system. 


TABLE  38 


TOTAL 

RMG  EKRORG  FOR  9 ETATE 

FILTER  WITH  R, 

GTATE  DEPENLENT 

Flight 

Pass  RMG 

RMG 

1 

6.6 

IP. 2 

I'i.h 

2 

Y.  1 

13.2 

lh.2 

3 

T.l 

12.9 

lU.l 

k 

6.6 

11.8 

U.h 

b 

7.0 

12.6 

13.5 
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TABLE  38  (Cont) 


Flight.  Pass 

KMo 

8ML  i-yQl 

HMG 

6 

6.7 

13.0 

l6.8 

7 

6.9 

13.0 

11. L 

8 

6.8 

13.0 

i6 . 6 

9 

7.3 

iU.O 

19.5 

10 

7.3 

11.6 

19.2 

11 

7.6 

19. 

19.6 

12 

8.0 

13.9 

11.5 

Average 

7.1 

13.1 

15.3 
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APPErroix  A 


THE  KALMAI'J  FILTER  EQUATIONS 


The  discrete  form  of  the  Kairaan  filter  equations  are  listed  here  for 
reference  together  with  the  names  commonly  associated  with  S'jme  of  the  terms. 

^n/n  “ ^n-1  ^n-l/n-l  Ni  ^*n  " **n  ^n-L  ^n-l/n-1^ 

Pn+1  = J-’n  - f'n  I^n  P’s"  ^ 

^n/n 
fn-l 

= gain 

= observation  matrix 

Pj^  = state  estimation  error  convariance  matrix 
= plant  covariance  matrix 
= observation  covai'iance  matrix 

^7^n  - »n  f’n-1  ^n-l/n-J  = innovation 

The  discrete  form  of  the  state  equations  arise  from  the  discretization  of 
the  continuous  first  order  differential  equations  called  the  plant  model. 

^n+1  “ ^n  “n 

The  sensor  model  is  linear  in  the  state  vai'iable. 

^n  ~ ^*n  ^n  ^n  ''’n 

The  underlying  statistical  assumptions  of  tiie  Kalman  theory  are  that  the 
additive  noise  in  the  plant  and  observation  models  is  Gaussian.  The  restriction 
on  the  observation  model  is  that  it  be  Linear  in  the  state  variables.  If  the 
condition  of  Gaussian  statistics  is  violated,  then  the  Kalman  filter  is  still 
tiie  best  linear  state  estimator. 


^ f'n  l^n  «n 

= estimate  of  state 
= state  transition  matrix 
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Al'l’KNlJlX  li 


blwCKi'TK  l'],ANT  I'XiUATlOtJ;; 


Here  the  diucrete  form  of  the  plant  equations  is  aerived.  The  identifica- 
tion of  the  terms  in  the  resulting  equations  which  are  needed  for  implementa- 
tion of  the  Kalman  filter  equations  is  made. 

In  continuous  form,  the  plant  model  is  written  as 

(B-1)  X = K X + G u 

Let  >l>  satisfy  the  differential  equation 

,p  = with  |J>(0)  = I. 

Then , 

- X)  = X + 4-"''-  X 

at 

But , 

(B-2)  4 = 1 

Differentiating  both  sides,  obtain 

^—1  ~ —(^—1  p 


Thus , 


T (4-"^  X)  = -4"^  4 4i“^  X + 4“'^  X 
dt 

= 4-^  (X  - FX)  = 4“^  G 


f d (4“^  X)  = f 4'^  G U)  d 1 

Jo  Jo 


Or, 


4"'^  (t)  X (t)  = 4~^  (0)  X (0)  + f 4~^  (t)  G w d T 

J 0 

X (t)  = 4 (t)  4"^  (0)  X (0)  + 4 (t)  f 1 : . 

J 0 
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DATE 

FILMED 


Since  4'"^  ( t ) = t ( -x  ) 

(B-3)  X (t)  * (t)  X (0)  + 


f 


i (t-x)  G (x)  u (x)  lix 


i'tii:;  eqnuLion  ix;  dixie  re  Li  zed  by  replacing  L with  (n+l)A  where  A in  Uie 
time  between  samples  and  n=0,l,2  Tims, 


X [(n  + i)A]  = *[(n  + 1)a]  X (O)  + -j[(n  + 1)a] 
But,  + 13)  = ♦(t;]^)  't(t2).  Hence, 


(n+l)A 


't'(-x)  Gii)(x)dx 


X [(n  + 1)a]  = 4>(A)  [4>(nA)  X (O)  + ♦(nA) 


y”nA 

0 


l'(-x)  Giij(x)dx 


/•  (n+1  )A 

4i(  -X  ) Go)(  X )dx  ] 
nA 


4>(A)  X (nA)  + 't(A)  l'(nA) 

( n+1 ) A 


r 

J nA 


(n+I )A 


<t(  -X  ) Gw(  1 )dx 


(B-ii)  X [(n  + 1)A]  = 4>(A)  X (nA)  + 4>(a) 


/ 

J nA 


4>(nA-x)  Gm(x)dx 


(B-5) 


Now  replace  o)(x)  by  i,  where  w is  the  time  averaged  white  noise.  That  is, 

*(n+l)A 

w(t)  dt 
nA 

Also,  change  variables  of  integration  by  letting  -x-+-  nA-x  . Then, 

•A 


X [(n  + 1)A]  = *(A)  X (nA)  + f(A) 


/' 


|^(-x  ) Gaidx 


♦(A)  X (n)  + 


/' 


♦(x)  Gudx 


is 


Changing  notation  so  that  X^  * X(n),  the  discrete  form  of  the  plant  model 


(B-6)  X^^^  = ♦(A)  X 


* r 


♦ (x)  G(idx 
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From  Xjj+i  = FfjXfi  + Gnuifi*  we  identify 


(B-7)  Fji  «-(A) 


and 


(B-8)  Gj,  ■> 


■11(1)  Gdi 


From  Equation  (B-3),  the  solution  to  the  homogeneous  part  of  the  state 
equat ion  i s 

(B-9)  X (t)  = -Kt)  X (0) 

Thus,  ♦(t)  can  be  obtained  explicitly  from  a solution  to  the  homogeneous 
state  equation.  Consider  the  plant  model 


Xg  = X3 
X = -aX-j  ♦ bu 

The  homogeneous  equations  are  obtained  by  setting  b = 0.  These  are  then 
solved  to  give 

X^(t)  = Xj(0)  + X^  (0)  t + [i  t + ^ 2 (e-*^^  -1)]  (0) 


XgCt)  = X^(0)  + ^ (l-e-'^t)  X^  (0) 


X3(t)  = e-at  X3  (0) 
By  inspection. 


(B-10)  ♦(A) 


* I2  (e- 


-1) 


017  (1-e-aA) 
81 

0 0 e"®^ 
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APPENDIX  C 


ACCELERATION  CORRELATION  FUNCTIONS 


The  correlation  function  for  each  of  the  acceleration  processes  described 
in  this  report  is  derived  below. 

Consider  the  simplest  acceleration  model  where  the  acceleration  is 
described  as  a first  order  Meirkov  process, 

(C-1)  X3  = -aX3  + bu 

Assuming  the  initial  condition  to  be  zero,  take  the  I.apace  transform  of 
both  sides  to  obtain 


(C-2)  S X3  (S)  = -aX^  (S)  -t-  bu  (S) 
The  transfer  function  H (S)  is 


H(G) 


X3  (S)  ^ b 
u(s)  S+a 


(C-3)  |h  (Juj) 


|2  = 


0)  +a 


If  8x3  is  the  power  density  spectrum  of  the  acceleration  and  the  power 
density  spectrum  of  the  white  noise,  then 

(C-U)  S^3  (u))  = |H  (Ja>)l^  S^  (u) 

Since  the  power  density  spectrum  of  wiiite  noise  is  unity. 


(C-5)  S^3  (o))  = |H  (Jou)|2  = 


b^ 


u,2+a2 


The  correlation  function  Rx3  (t)  is  the  inverse  Fourier  transform  of  the 
power  density.  Tiius , 


The  derivation  of  the  correlation  function  for  the  acceleration,  modeled 
as  a second  order  Markov  process  proceeds  along  similar  lines. 
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The  proceGs  is  described  by 

(C-7)  X3  = Xi,  + bu 

(C-a)  Xi,  = -a^X^  2tiX^^  + (d-2e)  bu 


with  = iuq2  + g2 


The  Laplace  transform  of  each  equation  gives 
(C-9)  a X,,  (S)  = X4  (S)  + bu  (S) 

(C-10)  S X4  (S)  = -a^Xj  (S)  -2fiX^  (S)  + (a  -26)  bu  (S) 

From  these,  one  obtains  the  transfer  function 

V ..  ^3  is)  b(S+a) 

(C-11)  H (b)  = — - -rq-r 5 — ^ 5- 

u {S)  + a‘^ 

= b (S-t-g) 


(S+26S+Wo2+62) 

b (S-*^a) 

(s+6+J<do)  (S+B-Juiq) 


Define , 

G(S)  H H(S)  = 

Let 

p = e-ju>o 

Then , 

(C-12)  G(S)  = 


-b^  (S*a) 


-b^  (G-*-a)(S-g) 


(C- 


(S+p*)  (S+p)  (3-p)  (S-p») 
13)  R (t)  = i-  I G (Jw)  eJwT  (iu) 

•/vOO 


G(S)e^'^  dfJ 


(s+B+Joiq ) (3+6-J(Uq)  (S-6-Ju)o ) 


2ti 


/*  (S-*-g)  (S-a)  e^^  dS 

(s*p»)  (s+p)  (s-p»)  (s-p) 


where  the  contour  of  integration  is  shown  in  Figure  C-1 . 


(S-6+Jii)o ) 
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Figure  C-1.  Contour  of  Integration 


This  contour  encloses  poles  at  S = -p  and  S = -p*.  From  residue  theory, 

Hx3  (t)  = (Ri  + Rg) 

where  Rj^  is  the  residue  of  pole  -p*  and  Rp  is  the  residue  of  pole  -p.  '1 


(C-ll«)  H(t) 


OQ 


cos  (Wf,T) 


APPENDIX  D 


SENSOR  COVARIANCE 


The  elements  of  the  sensor  covariance  matrix  R can  be  derived  in  a 

2 

straightforward  manner  in  terms  of  variances  of  the  range  error  Op  , azimuth 

2 2 2 2 2 
and  elevation  errors  o and  as  well  us  their  derivatives  o‘  , av  , c‘  . 

sp  {)  r\  V 

These  quantities  are  assumed  to  be  known  in  advance.  The  geometry  of  Figure  1 
of  Section  3 is  used  in  the  derivation.  The  sensor  variables  of  interest  are: 


(D-l)  = Rg  sin0g  cos*pg 

(D-2)  Zg  = Rg  sinOg  simPg 

(D-3)  Z3  = Rg  cos0g 

(D-U)  Zi^  = R sin0g  cost’s  + Rg  cos0g  coSg  0g  - Rg  sin0g  sin 
(D-5)  = Rg  sin0g  sin^^g  + Rg  cos0g  sinv’g  0g  + Rg  sin0g  cosing 

(D-6)  Z5  = Rg  COS0g  - Rg  Sin0g  0g 

where  the  subscript  s is  used  to  indicate  that  the  associated  quantity  is  the 
sensed  or  measured  value.  Since  the  measured  quantities  are  contaminated  with 
noise,  they  can  be  written  as: 


«s 

= R 

+ 

AR 

«s 

= R 

+ 

AR 

Os 

= 0 

+ 

A0 

Os 

= 6 

+ 

aS 

^s 

= V 

+ 

s 

= i 

+ 

where  R,  0,  , R,  0,  'f  are  the  noise-free  sensor  variables.  The  assumption  on 

the  noise  terms  AR,  A0,  A>^,  AR,  A0,  Av»,  is  that  they  are  stationary  and  inde- 
pendent with  zero  mean  values.  That  is,  E (AR)  = 0,  E (A0)  = 0,  E (A^p)  = 0, 

E (AR)  = 0,  E (A0)  = 0,  E (Ai>)  = 0;  E (ARA0)  = E (AR)  E (A0)  etc.  from  which  it 
follows  that  E (Rg)  = R,  E (0g)  = 0,  etc. 

If  X]^,  X2,  X3  are  the  variables  corresponding  to  the  coordinates  of  target 
position  along  X,  Y,  and  Z respectively,  and  Xij , X5,  X^  are  the  corresponding 
velocity  terms,  then  the  quantities  entering  in  the  sensor  covariance  matrix 
are ; 

(D-7)  0^^  = E (Z^-  X^)^  (ixl 6) 

and 

(D-8)  °xj  xj  “ - Xi)  (i'-j  - Xj)] 
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Thus,  for  example,  is  the  R^j  term  of  Section  3 for  i = 1,  2,  3. 

^ J 

o 

Consider  the  quantity  . Using  definition  (D-7)> 
a 2 = E (Z,  - X, )2  = E (Z  2)  _ x ^ 

XT  i . 11 


2 2 

= E {[(R  + AR)  sin  (0  + A0 ) cos  + A«p)  ]}  - 

= (R*"’  + sin^ip  sin^O  + (R^  + Oj^^)  Og^  cos^0  cos^'P 


+ (R^  + °R^^  °0^  ^ cos^0  sin^v>  + sin^O  cos^>fi 


where  we  have  used  the  result  E (AR)^  = Op^,  E (A0)^  = Og^,  E {b.'P)‘^  = and 

made  the  small  angle  approximations  sin  A0  =«  A0 , sinA'^=*=A'^,  cosA0  1,  cost^  = 1 

2 2 2 
Assuming  that  R > , the  expression  for  Ox^^f  reduces  to 

(D-9)  Oy,^  = R^[o^  sin^0  sin^>^  + cos^0  sin^v»  + cos^0  cos^i/’] 

2.2  2 
+ Op  sin  0 cos  >fi. 

2 

The  expression  for  o„  is  obtained  by  simply  replacing  by  90°  - ><>  in 

*2 

Equation  (D-9).  Thus, 

oppp  p PPP  2 P2  2 

(D-IO)  = R'[o  sin  0 cos  <p  + o cos  0 cos  + Oq  cos  0 sin  >/>] 

Xp  \p  V V 

2.2  .2 

+ o„  sin  0 sin  'fi. 

n 

2 

Replacing  0 by  90°  - 0 and  by  0°  in  Equation  (D-9),  we  obtain  o„  . Thus 


i2  . „ 2 


^2  , 2 


(D-il)  0^^  = r2  Og2  sin20  + Op2  cos^e 


The  quantity  o „ is  obtained  in  a similar  manner,  although  the  algebra 
*1  *2 

is  a bit  more  tedious. 
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'’’‘i  ^ ^ ^2^  " ^1  ^2 

= E{[(R+AR)  sin(0+AO)  cos('^+A'^)  [(R+AR)  sin(6+A0)  sin('^+A'P)  ] } - X^  X^ 

2222  2222 
= -(R  +a„  ) o„  cos  0 sinv>  cos'P  + (R  +0^  ) sin  0 cos'P  sin'^ 
no  n y 

o p p p p 2 ^ 

+ (R“^+ap  ) 0^  oO  cos  0 sins?  cos'^’  - sin‘"0  sinv’  cosi^ 

2 2 

Again,  ass’oming  that  R > reduces  to 

22222  22  22 

(D-12)  X ~ ^ ® * °R  ® cos'P  sin'#’ 

p P ^ P P 

where  the  additional  assumption  that  coi.  0 ^ cos‘-0  was  used. 

The  derivation  of  the  quantities  and  ^ proceeds  in  exactly  the 

Xj^x^  *2^3 

same  manner.  The  results  are 


X1X3 


(D-I3)  °x,Y-.  “ ^‘^R^  “ sin0  COS0  COS'#’ 

2 2 2 

(D-lU)  o„  „ = (a„  - R o„  ) cosO  sinO  sin'#’ 

xpx^  n y 


p 

For  the  velocity  term  is  -computed  as  follows: 


XI, 


= E (Zj^  - = E iZ^)  - X^2 

»2  2 22  2 22  2 
(D-15)  = (R  ■♦•  0^  ) [o^  sin  0 sin  '#’  + Og  cos  0 cos  '#’ 

2 2 2 2 2 2 2 
■*■  COS  0 sin  w]  + o-  sin  0 cos  '#’ 

9 ‘r  n 

+ R^(0^  •*■  Cg^)  cos^O  sin^'#’  + Og^  sin^0  cos^<fi 

* 00^  0^^  sin^0  sin^^]  + R^  Og^  cos^O  cos^ifi 


+ R^  sin^0  cos^'#’  + o ^ cos^O  sin^i# 
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pop  p 

Oq  cos  0 COS^' 


+ 2F®  ('^  Sin^e  cos'll  + 6 


cos‘-i/j]  + R'-  sin^e 


2 

■e  again  the  assumptions  R > 
simply  replace  'P  by  90°  - P . 


. 2 

0 0^  sine  cose  sin'<’ 

2 . 

Og  'P  cos  0 cosP)  sinP 


2 2 2 

Op  and  Oq  ■^1,0^^  <1  were  used.  To  obtain 

replace  P by  90°  - P.  The  result  is, 


(D-16)  j “■  = (R^  + 0 • *■ ) [o  ^ sin^O  cov/' P + o ^ cos^O  siri^>^ 

H P 0 

+ a ^ cos^O  cos^p]  + sin^O  sin^' 

U n 


sin^'^  + R^(6^  + a:^ 

2 2 2 2 
cos  0 cos  + Oq 


'^0  ^ 

2.2  .2 

+ Oq  Bin  0 sin 


2 2 2 2 2 
sin  + Gq  sin  9 cos  ' 

2 2 2 2 2 
R o:  cos  e sinS>  + R 

0 


+ R^ 


.,2^2  - 

'’O  °P 

sin^e  sin^'^ 


■P] 


* a ^ 


R^(p^  + o.t^ 

22  2 2222  2 
I cos  0 cos  •fi  ■*  a o cos  cos  O]  + R 
0 0 ^ 


2 2 

0*  sin  e cos‘‘i^ 

P 

**22  *2  2*2 
+ 2RR  0^  sin'^e  sin'^  ^ sin0  cosP  - o^‘^P  000*^0  sin'P)  cos'f 

2 

ivation  for  results  in 

o 2 2 P 

= R 0-  sin  0 + r‘^(o‘^ 

^6  0 


0.2 
"(0  + 


2 .2  2 .2  2 
0 e sin  0 + (R  +0' 
n R 


2 2„ 

) Og  cos  0 

2,2  2 

Op  ) «0  sin  0 


2 2 • • 2 
jp  cos  0 + 2RR0  Oq  sinO  cosO 


Now  compute  the  terms  which  couple  the  position-velocity  measurements, 
For  „ obtain 

Xi 

%xi,  - ^1)  Xl,)]  = E (ZiXi,)  - X^Xj, 


(D-18)  o * RR  (o^  sin^0  sin^ip  + o„^  cos^0  cos^i^ 

XiXj^  0 
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whereas 


+ 0^0^  cos^0  sin^i^)  - 0 o ^ sin0  cos0  sin^f 

• 2 „2  2„  . 

- 'P  0.  R cos  0 sinip  cosP 
6 


Xj_X^' 


Ox2X^  is  obtained  by  replacing  P by  90°  - in  the  expression  for 
Thus , 


• 2 2 2 2 2 2 
(D-19)  a = HR  (o.  sin  6 cos  •P  -t-  a.  cos  0 sin  P 

*2^5  0 

2 2 2 2 -2  2 2 
+ 0 o cos  0 cos  p)  - Q o R sin0  cos6  cos  P 


• 2 2 2 

- Uy  R cos  0 cos'P  sin'^ 


The  terra  o. 


'3^6 


(D-20)  o. 


3^6 


is  simply 

■ 2 . 2 
HR  o.  sin  0 
y 


The  remaining  covariance  terms  are  > '’x2Xg» 

o . However,  they  are  not  used  in  the  report  and  will  therefore  not  be 

X3X5 

derived  here. 


APPROXIMATIONS  TO  THE  R MATRIX 


Successive  implementation  of  the  R matrix  using  the  above  expressions  at 
each  iteration  time  can  be  a time-consuming  process.  It  is  therefore  desir- 
able to  approximate  these  expressions,  ideally  by  some  constant  numerical 
values.  This  is  necessary,  especially  if  one  attempts  to  achieve  a steady 
state  filter  design. 


Tiie  procedure  for  simplifying  the  expressions  will  be  simply  the  follow- 
ing; Each  expression  will  be  averaged  over  the  sensor  variables.  We  begin 

2 2 
with  . The  only  variables  appearing  in  are  R,  0 and  P . Average 

from  0 to  2-n  and  0 from  0 to  tt/2  and  assume  that  Oq^  < ^1(1^ ‘ '^^en. 


(2it)  (tt/2) 


2n 


2 2 2 2 2 
d0dV’  = 1/U  Ofj  + 1/U  R (o0  +0^  ) 
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\ 


;'imi  larly , 


I'or  ^ iirid  o„ 

Xg  x,^ 


1 

(2tt)  (ti/2) 


(2ti)  (tt_) 
2 


The  resulting  expressions,  which  are  functions  of  R,  ore  now  averaged 
over  R where  the  limits  on  R are  0 and  6xi0^m  (a  rather  extreme  upper  limit). 

2 2 2 2 2 2 
The  quantities  Oj^  , Ug  , are  taken  to  be  100m  , lfl<  , and  lfl(  respectively. 

This  results  in  the  numerical  values 

(D-21)  0^  2 ^ = U 

Xi  x^ 


(D-22)  o„  ^ = 56 

X3 


2 2 

In  a similar  manner,  one  obtains,  for  o„  , c^v  * 

*5  6 

(D-23)  ^ = o ^ = 12.5 

*1*  ^5 

(D-2U)  a ^ = 16 
''6 


where  the  limits  on  R,  0 and  are,  respectively,  ± 300u(/sec,  i 1 rad/sec,  and 
+ 1 rad/sec  with  = 5 m/sec  and  0^=0^=  .5M/sec. 
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APPENDIX  E 


INITIALIZATION  OF  POSITION-VELOCITY,  VELOCITY -VELOCITY  TERMS  OF  Pq 


The  velocity  variance  as  well  as  the  position-velocity  variance  terms  are 
computed  here  for  initialization  of  the  IP  matrix.  The  assumption  used  is  that 
the  sensor  provides  position  data  only.  Consider  the  terms  which 

couples  the  x-position  with  the  x-velocity.  Since  only  position  data  is 
available,  the  estimate  of  the  initial  x-component  of  velocity,  X2  (a),  is 
using  Uie  notation  of  Section  U, 


(E-i)  X2  (A) 


Zi  (A)  - Zi  (0) 
A 


where  A is  the  time  between  measurements  (O)  and  Zi  (a).  Thus, 

(E-2)  P^2  (0^  = E (X^  (A)  - X^  (A))  (Xg  (A)  - Xg  (a)) 

= - E (Z^  (A)  - (A))  [(Z;l  - ^1  ■ (^1  ■ ^1 


= 7 d„  ^ (A)  = 7 R,,  (0) 
A 3^1  A iJ- 


where  the  p<jsition  measurements  are  assumed  to  be  uncorrelated  in  time. 
Similarly,  (O)  which  couples  the  x-coordinate  of  target  position  with  the 

y-component  of  velocity  is  computed  by  writing 

(E-3)  Pj^^  (0)  = E (X;l  - ^1  (^5  - H 

= i E (Z^  (A)  - (A))  [(Z2  (A)  - X5  (A))  - (Zg  (0) 

- X^  (0))] 

_ 1 2-  _ 1 
A '’^1X5  “ A 

Similarly,  the  remaining  terms  may  be  written  down  by  inspection.  In 
summary , 

(E-M 

(E-5) 

(E-6) 

IOI4 


P12  (0)  =-H,i(0) 


Pl8  (0)  = T Rn(0) 


A 13' 


(E-T) 

^27 

(0) 

II 

ro 

(0) 

A 

R13 

(0) 

(E-8) 

^75 

(0) 

" ^57 

(0) 

1 

A 

R23 

(0) 

(E-9) 

^’78 

(0) 

^87 

(0) 

= I 

A 

^83 

(0) 

(E-10) 

I’ll. 

(0) 

= >’1.1 

(0) 

1 

A 

(0) 

(E-11) 

(0) 

(0) 

= L 

A 

^22 

(0) 

(E-12) 

"1*8 

(0) 

= f'81. 

(0) 

1 

A 

«23 

(0) 

where  A is  the  time  interval  between  the  I'irst  and  last  position  measurements 
prior  to  filtering. 
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A1 'PEND  IX  F 


COMPUTER  oOnVARE 


This  appendix  provides  the  computer  software  and  documentation  for  the 
nine  state  Kalman  filter  as  described  in  Cection  3.  The  data  presented  in  this 
report  was  generated  by  several  computer  programs.  The  most  general  program 
is  presented  in  this  Appendix.  It  was  constructed  in  a modular  form  to  permit 
experimentation  with  a variety  of  filtering  and  sensing  algorithms.  The  user 
may,  for  example,  modify  the  program's  form  to  obtain:  a steady  state  filter; 
a position  rate  sensor;  a correlated  noise  sensor  or  a filtering  arrangement 
composed  of  three  independent  three  state  filters. 

The  computer  language  implemented  on  the  CDC  65OO  computer  was  Extended 
Fortran  IV.  All  of  the  Fortran  statements  used  should  be  compatible  with 
similar  systems.  The  only  exception,  whose  form  might  vary  for  a different 
complier,  is  the  non-standard  ENTRY  into  a subroutine.  The  executable  field 
length  necessary  to  "run"  in  program  is  52000  octal  words  and  the  corresponding 
system  time  is  225.5  system  seconds. 

The  format  for  the  documentation  is: 

F-l)  A narrative  description  of  the  subroutines  used  to  simulate  and 
solve  the  estimation  problem. 

F-2)  An  analytical  description  of  the  main  program  and  the  subroutines 
containing:  flow  charts,  routine  summary,  and  an  abridged  variable  list. 

F-3)  A detailed  description  of  the  subroutines  and  corresponding  cluinges 
necessary  to  obtain  desired  filtering  and  sensirig  algorithms. 

F-i* ) An  index  to  subroutines  including  alpiiabetic  letter  reference 
appearing  on  flow  chart  diagrams,  memory  requirements  and  calling  and  returning 
arguments . 

F-5)  A computer  listing  ol'  the  main  program  and  corresponding  subroutines. 

ETATE  VECTOR 


Appears  in  Report 

Appears 

in  Appendix 

X(l) 

position  in  X-dii-ection 

position 

in 

X-di rection 

X(2) 

velocity  in  X-direction 

position 

in 

Y-di rection 

X(3) 

acceleration  in  X-direction 

position 

in 

/-di rection 

x(M 

position  in  Y-<iirection 

velocity 

i n 

X-<ii  rection 

X(5) 

velocity  in  Y-direction 

veloc ity 

in 

Y-di rection 

X(6) 

acceleration  in  Y-direction 

velocity 

in 

/-di rection 

X(7) 

position  in  '/-direction 

accelerat ion 

in  X-direction 

x(8) 

velocity  in  /-direction 

accelerat ion 

in  Y-direction 

X(9) 

acceleration  in  /-direction 

acceleration 

in  /-direction 
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NOTE: 


(1)  The  notation  in  the  main  report  and  in  this  Appendix  differ  in  the 
description  of  the  target  state  vector. 

This  difference  in  ordering  of  the  state  variables  affects  the  arrange- 
ment of  the  elements  in  the  P,  R,  K,  F,  G,  GH  and  XH  matrices. 

(2)  All  data  used  and  computed  in  the  main  program  and  corresponding 
subroutines  are  expressed  in  the  M-K-S  units.  Other  units  can  be  used,  if 
desired,  by  changing  the  appropriate  numerical  specification  of  the  target 
state  vector  and  sensor  accuracy. 

(3)  The  abbreviations  used  throughout  the  appendix  are: 

TA  = target  aircraft 

TAFP  = target  aircraft  flight  path  - refers  to  the  state  along  the 
flight  path 
MG  = mean  square 

MSE  = mean  square  error 

(h)  'Phe  solution  in  the  state  estimator  requires  the  inversion  of  a 
3x3  matrix.  The  subroutine  used  to  accomplish  this  implements  the  Adjuinct 
Method.  This  is  a direct  method  of  inverting  matrices.  The  indirect  methods 
tried,  such  as  elimination,  proved  unsatisfactory  because  of  a large  build-up 
of  round-off  error  in  the  algorithm.  The  Adjuinct  algorithm  bounds  the  limit 
of  round-off  error.  For  further  details  see  description  of  Subroutine  INVERT. 

(5)  The  Subroutines  RANGE,  THET,  and  PHI  transform  data  represented  in  a 
X-f-Z  coordinate  set  to  a R-0-<>  set.  This  is  similar  to  the  coordinate  set 
described  in  Section  3,  except  that  0 is  replaced  by  90°  - i and  by  90°  + 4>. 

It  is  possible  for  the  user  to  assign  his  own  coordinate  system  by  replacing 
the  three  subroutines  mentioned  and  the  specified  transformations  of  sensed 
position  data  in  subroutine  SENSOR. 

(6)  The  plotting  routines  used  to  generate  the  graphs  in  the  report  are 
not  listed.  These  routines  were  a package  of  special  purpose  routines  available 
on  Picatinny  Arsenal's  computer  system.  The  user  may  incorporate  his  own 
routines  in  Entry  COMP.  This  subroutine  stores  most  of  the  important  variables 
for  the  complete  target  aircraft  flight  path. 
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NARRATIVE  DESCRIPTION 


In  order  to  begin  the  filtering  process,  the  psu-aineters  of  the  filter  must 
be  specified  (Subroutine  INITIAL).  It  is  also  necessary  to  initialize  the  state 
variables  as  well  as  the  corresponding  error  covariance  matrix  (Subroutine 
start).  The  simulated  sensor  (Subroutine  SENSOR)  begins  operation  with  the 
"true"  target  aircraft  state  (Subroutine  ACTUAL  or  Subroutine  OWN)  and  adds 
white  or  correlated  noise  (Subroutine  CORLATE  and  Subroutine  RAIID)  to  the  state 
variables  corresponding  to  position  or  position  and  velocity.  The  "true" 
target  aircraft  state  is  generated  in  an  X-Y-Z  coordinate  set  (Entry  DATA  or 
ENTRY  comp)  and  transformed  to  a R-0-i|)  representation  (Subroutines  RANGE,  THET, 
and  PHI).  Noise  is  added  to  the  appropriate  state  variables  in  the  R-(3-(Ji  set, 
then  transformed  back  to  the  X-Y-Z  set.  This  output  of  the  simulated  sensor 
is  an  input  to  the  Kalman  filter,  which  provides  an  estimate  of  the  present 
state  of  the  target  (Subroutines  FILTER,  MI^RD,  MTRA,  and  INVERT).  The  differ- 
ences between  the  true  and  estimated  state  as  well  as  the  true  and  sensed 
state  are  computed  (Subroutine  COLLECT).  This  information  is  periodically 
printed  (.Subroutine  OUTPUT)  and  constantly  stored  in  memory.  The  mean  square 
statistic  is  computed  and  printed  based  on  the  differences  calculated  along 
the  entire  target  aircraft  flight  path  (Subroutine  STATl ) . 
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I’HOGHAM  Kl>OW  AND  AIJALYtUD 


AIL  variables  ajipearing  in  bliis  section  are  listo.i  wiUiin  t.he  subi\)ut,  i nc 
in  wLiicb  Uiey  are  derined.  The  variable  List  includ<.*d  in  tliir.  section  ccjiitains. 
ail  program  variables  except  those  used  for  temporary  ;;t(jrage. 


Main  Progffuri  XYZ 


The  function  of  the  main 
program  is  to  call  the  sub- 
routines necessary  to  obtain 
the  filter  solution.  The 
task  and  organization 
this  routine  is  illustrated 
by  tlie  accompanying  flow 
diagram. 

Variables : 

IPRINT  = Specifies  the 
frequency  with  which  the 
filtered  and  "true"  state 
are  printed, 

II  = Do  loop  parameter 
for  filtering 


UO 


Gabroutine  INITIAL  - A 


Initialize 
Model  that 
Simulates  TAF1> 


initialize 
Model  that  uses 
Real  Data  for  TAFl^, 


Set  Seed 
Number  for 
Random  Number/ 
Generator 


Initialize  filter  model 
of  TA,  includes  state 
transition,  exitation,  ob- 
servation, randomness  and 
Rain  matrices 


f [nitializeX 
/state  VcctorX 
( and  Krror  \ 
\ Covariance/ 
\ Matrix  / 


Return 


Tliis  routine  initizlizes 
all  appropriate  data  and 
assigns  values  to  user 
specified  parameters.  The 
model  to  generate  the  TAPF 
is  choosen  from  two  alter- 
natives C6cF  on  diagram 
(left).  The  matrices  that 
appear  in  the  Kalman  filter 
equations  are  also  initializ- 
ed. 

Variables : 

L = number  of  target 
state  variables 

n.T  = Determines  whicfi 
model  is  used  to  generate 
the  TAFP  (see  comment  cards 
in  computer  listings  of 
Subroutine  INITIAL). 

SIG  = estimated  maximum 
acceleration  squared  of  TA  along 
cither  X,  Y,  or  Z coordinate 
axis. 

AllX,  AlIY,  AJIZ  = al,  a2,  a3 

HKl.l) m(9,9)  = 

state  transition  matrix 

H(l,l),  ....  H(3,9)  = 

state  observation 

GH(1,1),  ...,  GH(9,3)  = 

state  exitation  matrix 

Q(l,l) Q(3,3)  = 

state  randomness  covariance 
matrix 
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Subroutine  SENSOR  - B 


The  purpose  of  this  routine  is 
to  simulate  the  sensor.  An  input 
necessary  to  the  simulation  is 
the  "true"  TA  state.  This  is 
either  generated  from  simulated 
or  a;tual  data  as  previously 
described.  To  the  "true"  TA 
position,  expressed  as 
the  appropriate  noise  terms 
obtained  from  a random  number 
generator  are  added.  The  sensed 
values  of  R-9-0  and  their  co- 
variance  are  converted  back  into 
the  X-Y-Z  set  as  required. 

Variables : 

SICR  = variance  of  sensor 
in  range  - R 

SICTU  = varianci-  of  sensor 
in  theta  - 9 

Srcni  = variance  of  sensor  in 
plii  - 0 

XII (1),  XH(2),  XII (3i  = independ- 

ent standard  normal  random  variables 

RS  = sensed  range 

THSN  = sensed  theta 

PHSN  = sensed  phi 

Z(l),  Z(2),  Z(3)  = sensed 

position  TA  in  X-Y-Z  set 

R(l,l) R(3,3)  = co- 

variance  of  sensor  matrix  in 
X-Y-Z  set. 
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Lliibrout ine  FILTER  - C 


Compute 

Error  Covariance 
Matrix 


Compute 

Cain 

Matrix 


Compute 

Estimated 

State 


ISlocks  make  use  of 
Kj  L and  M 


This  routine  implements  the 
Kalman  equations  as  described 
in  Section  3.  An  input  to 
this  routine  is  noisy  position 
measurements.  The  ovitput  is 
tlie  estimate  of  TA  state. 

In  the  filtering  process,  the 
P and  K matrices  are  updated. 

Execution  of  this  routine 
requires  call  statements  to 
MJ'RD  and  MTRA.  It  should 
bo  noted  that  those  routines 
do  not  appear  in  the  ac- 
companying diagram. 

Variables : 

1>(1,1),  ....  P(9,9)  = 

state  error  covariance  matrix 

K(l,l),  ....  K(9,3)  = 

state  gain  matrix 

Xll(l),  ....  XH(9)  = 

estimated  state  vector 
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Subroutine  COLLECT  - D 


^ Entry ^ 


Store  Computed 
Differences  Ke tween 
True -Estimated 
Tirue -Sensed  State 


^Return^ 


This  routine  computes  and 
stores  the  difference  between 
true  and  estimated  state  as 
well  as  the  true  and  sensed 
state  variables.  As  an  option, 
the  user  may  utilize  the  routine 
for  statistical  or  special  out- 
put purposes.  Additional  program 
variables  may  be  accessed  by 
expanding  the  argument  lists 
of  the  call  and  Subroutine  state- 
ments, 

Varial)les : 

DXP(n),  DXV(Il),  DXA(ll),  DYP(Il), 
DYV(il),  DYA(II),  DZP(Il),  DZV(II), 
DZA(Il)  = differences  between  tlie 
true  and  sensed  position  in  the 
X-Y-Z  set  for  the  Ilth  iteration, 
respectively, 

DXS(ll),  DYS(Il),  DZS(II)  = 
differences  between  the  true  and 
sensed  position  in  the  X-Y-Z  set 
for  the  Ilth  iteration,  rcspi!ct i ve  1 y . 


Entry  PLOTTING  - D' 


^ Ent  ry  ^ 


Compute 
MSE  of  True- 
Estimated  6t 
True-Sensed 
State 


Optional 
Plotting  of 
Stored 
Variables 


Tlte  second  segment  compvite.s 
the  MS  statistic  for  the  state 
estimation  error  and  the  sensor 
error.  If  optional  storage 
of  additional  variables  was 
utilized  in  the  first  segment, 
then  any  appropriate  statis- 
tic could  be  generated. 

* At  this  point  a plotting 
routine  could  be  implemented 
by  the  user  to  plot  selectively 
stored  variables. 

Variables : 

SlG(l) SIC (9)  = the  MSE 

for  true  - estimated  state  in 
the  X,  Y,  Z direction  for  the 
entire  TAFT,  respectively, 

SIG(IO),  SlG(ll),  S1G(12)  = 
the  MSE  for  the  true  - 
sensed  state  in  tlie  X,  Y,  Z 
direction  for  the  entire  TAFP, 
respectively. 


Subroutine  OUTPUT  - E 


^Entry  ^ 


Print 

Selected 

Information 

^Re  tu 


This  routine  provides  an  output 
for  the  printer.  This  includes 
printing  the  true  state  variables^ 
estimated  state  variables,  and 
errors  in  estimated  state  vari- 
ables. The  frequency  of  printing 
is  controlled  by  the  main  program 
variable  IPRlN'r. 

Variables ; 

XXll(l) XXU(9)  = difference 

between  true  and  estimated  state 

lABS,  lABT,  lABE,  LABM  = lables 
for  output  headings 


lib 


Subroutine  ACTUAL  - F 


^Kntry  ^ 


Read  From 
Magnetic 
Tape  Initial 
TA  Conditions 


f ^ 

f Return  ) 


This  is  a special  purpose  routine 
that  gem'rates  the  TAFl’  from  real 
data.  The.  first  segment  inputs 
tile  dummy  header  and  the  number 
of  data  records.  The  initial 
state  of  the  TA  is  then  inputed . 
Tlie  technique  implemented 
in  this  routine  is  applicable 
only  if  the  user  has  TAFP  data 
in  the  form  of  initial  state  and 
a complete  acceleration  time 
history  of  the  TA,  If  real  data 
is  available  to  the  user  in  some 
other  form,  then  he  may  construct 
his  own  model  within  the  framework 
of  this  routine. 

Variables : 

COM  = dummy  variable  used  to 
advance  unnecessary  records  on 
magnetic  tape. 

NUMIJliR  = total  number  of  data 
records  available  for  TAFP 

NENI)  = number  of  data  records 
containing  states  of  TA  that 
are  to  be  filtered. 

or  = actual  time  increment 
between  records  containing  data 
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Kritry  DA'l'A  - F' 


^ Kntry ^ 


Compute 
True  State 
of  TAFT  in 
X-Y-Z  set 


Convert 

State  in  X-Y-Z 
Set  to  R - set 


Convert 

State  in  X-Y-Z 
set  to  0 - set 


This  second  sej^ent  generates 
the  T4F’F  given  the  initial  state 
and  the  acceleration  time  history. 
Tliis  is  accomplished  as  referenced 
in  Section  2.  The  Ilth  state  is 
generated  in  an  R-9-0  representa- 
tion. The  user  may  substitute 
his  owii  coordinate  set  by  replacing 
Subroutines  RANGK,  TllKT  and  PHI 
with  his  own  routines. 

Variables : 

X(l),  ...,  X(9)  = true  state  of 
TA  in  an  X-Y-Z  set 

RC(1),  RG(2),  RG(3)  = TA  state 
represented  in  R - set. 

TH(1),  TH(2),  TH(3)  = TA  state 
represented  in  0 - set. 

PHI(l),  PHI  (2),  PHI (3)  = TA 
state  represented  in  0 - set 
D(l),  ...,  D(9)  = true  state  vector 
of  TA  represented  in  an  R-0-0  set 
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; '.u  liroii  t i ti' ■ - f', 


Initialize  Model 
To  Generate  Simulated 
TAFP,  including  state 
Vector,  Transition, 
Kxitation  and  Covariance 
of  Randomness  Matrics 


In  this  routine  the  TAFP 
is  generated  by  implementing 
a model  similar  to  the  plant 
model  used  in  constructing 
the  Kalman  filter  equations. 

The  difference  between  the 
two  models  arises  from  the 
choice  of  the  parameters  ai, 
a2,  and  a3.  The  first  segment 
of  ttie  routine  initializes 
all  appropriate  data  and 
assigns  values  to  user 
specified  parameters. 

Models  otlier  than  those  ap- 
pearing in  tlic  body  of  the 
report  may  also  be  incorporated 
into  this  routine. 

Variables : 

AX,  AY,  AZ  = al,  a2,  a3 

SIC  = maximum  acceleration 
squared  of  TA  along  either 
X,  Y,  or  7.  axis,  respectively. 

1)T  = time  difference  between 

states  generated  by  model  for 
TAl’P 


NbNI)  = number  of  data  records 
which  will  be  generated,  con- 
taining simulated  state. 

X(l),  ...,  X(9)  = true  state 

of  TA  in  an  X-Y-Z  set. 

K (1,1),  ...,  F(9,9)  = state 

transition  matrix. 

G(l,l),  ...,  C(9,3)  = state 
exitation  matrix 

Q(l,l),  ...,  Q(3,3)  = state 
randomness  covariance  matrix 


Jl8 


Kntry  COMI 


G' 


The  second  segment  of  this 
routine  generates  the  II th 
simulated  TA  state.  This 
state  is  computed  in  an 
X-Y-Z  set  and  then  trans- 
formed to  an  R-9-0  set. 

Variables : 

W(l),  W(2),  W(3)  = Ul, 

U2,  U3. 

I),  Til,  RG,  and  PHI  are  the 
same  variables  as  described 
in  F. 
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r.ubvoutirie  liMil)  - H 


This  routine  generates  a sample  of  random  variables  from  either  a popula- 
tion which  is  normally  distributed  with  mean  zero  and  variance  one  or  from  a 
population  unifomly  distributed  on  the  closed  interval  zero  to  one.  It  war. 
(,'iken  I'rom  the  L0KAAD3  model  developed  by  Litton  Industries  for  the  Frankford 
Arsenal . 

Initialization : 

N = 0 ( Integer  ) 

X(l)  = Five  digit  positive  whole  number  to  be  used  as  a seed  number  (Real). 

Actual  Usage: 

N = integer  number  (#0)  which  determines  the  number  of  identically  inde- 
pendent random  variables  that  are  generated.  II  < 0 provides  uniform  random 
variables,  N > 0 provides  nomal  random  variables. 

X(l),  ...,  X((n()  = an  array  of  length  "N"  containing  the  specified  type 
of  random  variables  ("N"  is  restricted  only  by  the  Dimension  of  X). 
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Subroutine  ZERO  - I 


Thii;  foutiin.'  ;;eti;  t'j  /.fro  a opecifif]  matrix  or  a apecil'ied  vector, 
computer  listingu  at  the  end  of  this  Appendix  for  this  routine  are  seif- 
ex  planatory . 


Subroutine  START  - J 


This  routine  initializes 
the  target  state  vector  and 
the  corresponding  error 
covariance  matrix.  The 
initialization  scheme  is 
described  in  Section  4. 

Variables : 

11  = 1 

12  = number  of  initial 

measurements  to  be  made 
in  order  to  initialize  the 
estimated  state  and  its 
covariance, 

I = Do  loop  parameter  of 
the  initilization  loop, 

ZVd.l) ZV(3,12)  = 

stores  the  measurements  of 
the  sensor  for  the  1th 
iteration, 

V(l,  1,  1),  ,,,,  V(3,  3,  12)  = 

stores  the  covariance  of  the 
sensor  for  tlie  Ith  iteration, 

XH(1) Xll(9)  =•  estimated 

state  vector  of  TA, 

P(9,9)  = state 

error  covariance  matrix. 


1?1 


The 


Subroutine  Ml'RD  - K 


This  routine  muitiplieu  two  properly  defined  matrices.  The  computer 
Ih'.tliif'  for  this  routine  at  the  end  of  this  appendix  is  self-explanatory. 


Subroutine  - L 


'ITiis  routine  transposes  a matrix.  The  computer  listing  for  this  routine 
at  the  end  of  tliis  appendix  is  self-explanatory. 


Subroutine  IIJVEKT  - M 


This  is  a special  purpose  routine  used  to  invert  a 3 x 3 matrix  in  the 
most  efficient  manor.  It  employs  a direct  metliod  known  as  the  Adjoint 
algorithm.  The  inverse  obtained  is  for  all  practical  purposes  exact,  because 
the  algorithm  employs  a test  on  the  detej-minant  of  the  matrix.  This  test 
compares  the  value  of  the  determinant  with  a specified  value  (in  this  case 
.01).  If  the  determinant  is  less  than  this  value  the  complete  progr;jm  stops. 
Thus,  the  possibility  of  round-off  error  due  to  "near  singular"  matrices  is 
eliminated. 


f-ubroutine  I'.TATi  - N 


This  routine  computes  the  mean  square  statistic  of  a given  array. 
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KATJGK  - 0,  TilJ-.T  - i',  I’HI  - Q 


These  three  routines  together  convert  ttie  TA  state  vector  from  an  X-Y-Z. 
coordinate  set  to  an  R-O-ifi  coordinate  set. 


Vari  allies : 


D{1),  D(9)  = TA  state  vector  represented  in  an  X-Y-Z  set. 


0 


X(l),  X(2),  X(3)  = H,  H,  H 

R = range 

RDOT  = range  rate 

RDDOT  = range  acceleration 


P 


N = this  integer  counts  tlie  number  of  times  the  angle  0 changes 
sign.  The  desired  representation  for  0 is  a positive  angle, 
but  the  ATAN2  Fortran  function  is  defined  for  -n  <0  < r. 
Thus,  6 is  ti’ansi’ormed  to  0 < 0 < 2 * . 

X(l),  X{2),  X(l)  = 0,  0,  0 
TllKTA  = theta 

TTJOT  = angular  rate  of*  t.heta 

TDhOT  = angular  acceleration  of  theta 


Q 


X(l),  X(2),  X(3)  = 'P,  <j,  P 
PHI  I = phi 

PDOT  = angular  rate  of  phi 

PDDUT  = angular  acceleration  of  phi 
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OFl’IONAI.  FILTERING  AND  SENSING  ALGORITHMS 


'i'll'-  mo'li  iof.:;  'ji',  -iri'l  tt'i'li tionu  to  the  complete  comp'Jter  program  are 

pr''.;fiit'‘<l . This  pentits  the  user  to  simulate  a variety  of  filtering  and 
sensing  algorithms  utilizing  the  basic  form  of  the  previously  describei-1 
computer  program. 


Subroutine  CORR 


This  routine  generates 
correlated  noise  that  is 
added  to  the  true  TA 
position  variables  to 
provide  the  simulated 
sensor  measurements. 

The  input  to  this  routine 
is  a vector  of  size  3 
that  is  composed  of 
independent  normally 
distributed  random 
variables  with  zero  mean 
and  variance  one.  The 
output  is  a vector  of 
time  correlated  noise. 


Since  this  is  an  optional  routine,  it  must  be  inserted  into  the  complete 
computer  program.  There  are  some  modifications  to  Subroutine  SENSOR  which  ar 
required.  The  statements  in  SENSOR  corresponding  to  noise  terms  being  added 
to  the  true  position  ar'e  to  be  replaced  with 

RS  = X(l)  + COR  (i) 

THS  = X(2)  + COR  (2) 

PHS  = X(3)  + COR  (3) 

and  an  additionad  statement  Just  before  this  substitution  is  to  be 
CALL  CORR  (COR,  XN). 

As  seen  above  COR  is  a three  element  array.  It  must  be  dimensioned  in 
storage  by 

COMMON /CORRL/COR( 3) 


Generate 
Correlated  Noise 
to  be  added  to 
the  True  TA 
Position  Measure- 
ments in 
R-0-0 


corresponding  to  an  identical  statement  in  Subroutine  CORR. 


Variables ; 


COKTO  = correlation  time  (assumed  the  same  for  R,  8,  measurements). 

DT  = time  increment  between  measurements  (same  as  DT  in  other  routines). 
ALl’  = reciprocal  of  correlation  time. 
liliJR  = variance  of  range  mea.  arements . 

‘.'IGTH  = variance  of  theta  measurements. 
lilGl’ll  = vai'iance  of  phi  measurements. 

COR(l),  C0R(2),  C0R(3)  = correlated  noise  in  R,  8,  ifi  set. 
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Kati'  Mfa.siirfim  nt  s 


riie  ndilitioii  of  rot'.-  im'asurements  R,  0,  and  (J)  to  a position  only 
sonsor  can  bo  easily  accomplislted.  The  necessary  modifications  involve 
au>;mentlng  selected  matrices  and  restructuring  certain  subroutines. 

The  changes  are  the  following: 

Matrices : 

1)  H - observation  matrix 

2)  R - covai’iance  of  sensor  matrix 

3)  Z - sensor  matrix 

4)  K - gain  matrix 

Wlierever  in  the  complete  listings  Z,  11,  R and  K appear  dimensioned  in 
storage,  they  must  be  changed  to  Z(6),  11(6,9),  R(6,6)  and  K(9,6). 

Siilirout  ines ; 

INITIAl, 


The  call  to  Subroutine  ZKRO  that  contains  K and  H must  be  changed  to 
the  proper  dimension. 

The  new  11  matrix  is  defined  byH(i,  i)  = 1,  i = 1,  6 and  H(i,  j) 

= 0,  i 

The  Call  to  Subroutine  START  as  well  as  Subroutine  START  may  be 
eliminated  since  the  object  of  START  is  to  obtain  an  estimate  of  velocity 
and  its  covariance.  The  initial  estimate  of  TA  state  is  composed  of 
the  sensor  measurements.  The  elements  of  the  initial  state  estimation 
covariance  matrix  consists  of  the  variance  of  the  sensor  measurement 
expressed  in  the  X-Y-Z  coordinate  set.  The  initial  estimate  of  accelera- 
tion remains  zero  with  error  constrained  by  the  physical  limitation  of 
TA  wliich  is  the  Fortran  variable  SIC. 

The  K matrix  is  augmented  so  that  K(4,  4)  = K(5,5)  = K(6,6)  = ,5 
wfiich  ignores  cross  terms.  This  is  a good  approximation  that  is  quickly 
corrected  in  succeeding  iterations  of  the  filter  equations. 

FILTF.R 

In  addition  to  the  modification  in  the  dimension  of  the  previously 
stated  variables,  the  variables  HT(9,6),  KT(6,9),  PHTl9,6),  HPHT(6,6), 
RI’(6,6)  and  RJ1I(6,6)  arc  to  be  dimensioned  in  storage  as  shown  here. 

Also,  within  executable  statements  where  these  variables  appear,  the  numer- 
ical three's  are  to  be  replaced  by  numerical  sixes. 
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Th<>re  Is  a Call  to  Subroutiru-  INVKRT.  The  routine  wliich  appears  in 
tho  iimipiiter  listings  Is  a special  routine  that  only  inverts  a 3 x 3 
matrix.  The  user  must  provide  his  own  routine  to  invert  a 6x6  matrix. 


SENSOR 

In  addition  to  the  modification  in  the  dimension  of  the  previously 
stated  variables,  the  variable  XN(6)  is  dimensioned  in  storage  as  shown 
here.  The  rate  sensor  covariance  terms  used  in  the  report  are  as  follows: 

SICRl)  = 25. 

SICTHD  = SICRHD  = .25  K-06 

SMITH  = SICIH  + SIGPH 

SUniTU  - SIGTHD  + SIGMIU 

The  new  sensed  R,  9 , i|>  arc  defined  by: 

RDS  = 0(2)  + XN(4)  * SQRT(SIGRO) 

THOS  = 0(5)  T XN(5)  ••  SQRT  (SlGTllO) 

HHOS  = 0(8)  *■  XN(6)  SQRT  (S ICHIO) 

The  additional  sensor  measurements  in  an  X-Y-Z  coordinate  set  are: 


Z(4)  = -ROS  * COS  (JUS)  * SIN  (THS)  T RS  * SIN  (TUS)  * SIN  (PHS) 

* PHOS 

Z(5)  = ROS  * COS  (THS)  * COS  (MIS)  - RS  * SIN  (MIS)  * COS  (THS) 

* MU)5  - RS  * COS  (PHS)  --  SIN  (THS)  •••  THOS 

Z(6)  = ROS  * SIN  (MIS)  + RS  * COS  (MJS)  * PHDS 

The  R matrix  now  becomes  a 6 x 6 matrix  with  the  following  additional 
terms : 


ROS2  = RDS  * ROS 
THDS2  = THOS  * THOS 
PH0S2  = MiOS  * MiDS 

R(4,4)  = (RDS2  + SICRO)  * (SIGTH  * TC2  * PC2  + SlGMl  * PS2  * TS2  + 

SIGTH  * SlGMi  * PS2  * T(2)  + (SIGTH  * PS2  -•  TC2  + SIGPH  * PC  2 * TS2  + SIGHf 

* SIGPH  ->  PC2  * TS2)  + RS2  * SIGPHD  * PS2  * TS2  + RS2  * (THDS2  + SIGTH)  * 

(SIGTH  * PC2  * TS2  + SIGPH  * PS2  + TC2  -f  SlCni  * SIGPH  * PS2  * TS2)  + 

RS2  * SIGTHD2  * PC2  * TC2  + 2.  * RS  * RDS  * (THOS  * SIGTH  * PC2  * TS2 

- PHDS  * SIGPH  * PHC  * PHS  * THC  + SIGPH  * IHDS  * PS2  * THS)  * PHC 

R(5,5)  = (RDS2  + SIGRD)  * (SIGTH  pc2  * TS2  i SICMI  * l’S2  * TC2 
SIGTH  * SIGPH  * PS2  * TS2)  + SKJRD  * l'C2  TC2  I RS2  v (nii)S2  + SlGl’HO) 

* (SIGTH  * PS2  * TS2  + SIGMI  * TC2  PC2  -f  SIGTH  * SIGMI  * PC2  * TS2)  + 

RS2  * SIGPHD  * PS2  * TC2  + RS2  * (T11DS2  + SIGTHD)  * (SIGMI  PC2  •'<TC2  + 

SIGMJ  * PS2  * TS2  + SIGTH  * SIGMI  * PS2  * TS2)  + RS2  * SIGTHD  * PC2  * 

TS2  - 2.  * RS  * RSD  * (THDS  * SICTH  '.v  pc2  * thC  + PHDS  * SICIH  * PHC  * 

MIS  * niS  - SIGMI  * THDS  * PS2  * THC)  * THS 
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R(6,6)  = RS2  * PC2  H RS2  * (PUDS2  + SIGPH)  * SIGPH  * PS2  + SIGR  * 

PHDS2  * PC2  + (RDS2  + SIGRD)  * SIGPH  * PC2  + SIGRD  * PS2  -2.  * RS  * RDS 

* PHDS  * SIGPH  ■*  PHC  * PHS 

R(l,4)  = RS  * RDS  * (SIGTH  * PC2  * TG2  ^ SIGPH  * PS2  * TS2  + SIGTH 

* SICHI  * PS2  * TC2)  - PHDS  * SIGTH  * RS2  * PHC  * PHS  * TC2  + THDS  * 

SIGPH  * RS2  * PS2  * niC  * lUS 

R(2,5)  = RS  * RDS  (SIGTH  * PC2  * TS2  ^ SIGPH  * TS2  * pc2  + 

SK.TH  * SIGPH  * PS2  * TS2)  + PHDS  * SIGTH  * RS2  ■*  PHC  * PHS  * TS2  + 

THDS  * SIGPH  * RS2  * PS2  * THS  * THC 

R(3,6)  = RS  •••  RDS  * PC2 

Tlic>  olemcMits  R(4,l),  RC3,2),  R(6,J;  arc  equivalent  to  R(l,4),  R(2,5), 
R(J,())  since  R is  a syimtric  matrix.  Tlu  R(1,0),  R(l,6),  R(2,4),  R(2,6), 

R(3,4)  and  R(3,5)  elements  are.  not  >>iven,  but  may  be  easily  derived 

by  the  user.  Kiements  not  described  are  set  to  zero. 

COLLECT 

In  addition  to  the  modification  in  the  dimension  of  the  previously 
stated  variables,  the  new  variables  DXS(300)  DYSV(300),  DZSV(300)  must 
be  inserted.  Also  , S1G(15)  is  to  be  dimensioned  in  storage  as  shown 

here. 

The  differences  between  the  true  velocity  and  the  sensor  measurement 
of  velocity  is  computed  as: 

DXSV  (II)  = X(4)  - Z(4) 

DYSV  (II)  = X(5)  - Z(5) 

DZSV  (II)  = X(6)  - Z(6) 

Entry  PLOTING 

The  mean  squared  velocity  error  is  computed  and  printed  by  the  following 

CALL  STATl  (DXSV,  N,  SIG(13)) 

CALL  STATl  (DYSV,  N,  SIG(14)) 

CALL  STATl  (DZSV,  N,  S1G(15)) 

PRINT  3000,  (SIG(I),  I = 10,  15) 
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Uncoupled  Filter 


The  plant  model  for  the  TA  utilized  by  the  Kalman  filter  is  con- 
structed with  state  variables  represented  in  an  X-Y-Z  coordinate  set. 

The  triplet  of  state  variables  (position,  velocity  and  acceleration) 
for  each  coordinate  axis  is  assumed  to  be  independent  of  triples  with 
respect  to  other  axis.  However,  the  X-Y-Z  coordinate  set  is  not  com- 
patible with  the  R-tt-0  set  of  the  sensor  measvirements  which  are  assumed 
to  be  iiulependent  of  each  other.  In  order  to  make  the  sensor  data  com- 
patible witli  the  filter  equations,  the  independent  K-H-0  measurements 
ari‘  transformed  to  dependent  X-Y-Z  measurements.  The  dependence  is 
reflected  in  the  non-zero  off-diagonal  elements  of  the  R matrix.  The 
uncoupled  three  state  filters  can  now  be  obtained  from  the  nine  state 
filter  by  settint'  tlie  off  diagonal  elements  of  the  R matrix  equal  to 
zero. 

Similar  problems  are  inherent  in  the  rate  aided  sensor,  except  that 
there  are  three  additional  rate  measurements.  Again,  the  sensor  vari- 
ables are  transformed  into  the  X-Y-Z  set.  By  setting  the  off  diagonal 
elements  in  the  resulting  R matrix  equal  to  zero,  the  user  obtains  the 
decoupled  three  state  filters. 

Steady  State  Filter 

Having  uncoupled  the  nine  state  filter  by  setting  the  off  diagonal 
elements  in  the  R matrix  to  zero,  the  user  must  now  replace  the  remain- 
ing diagonal  eliments  with  constant  values.  This  eliminates  the 
dependence  of  the  filter  equations  on  the  target  state.  These  elements 
in  the  R matrix  are  assigned  the  following  values. 

Position  only  sensor  model : 

R(i,  i)  = SIGR  i = 1,  2,  3 

Rate  aided  sensor  model : 

R(i,  i)  = SIGRU  i = 4,  5,  6 

To  obtain  steady  state  results  the  entire  computer  program  XYZ  must 
be  processed  twice;  the  first  time  using  constant  values  in  the  R matrix 
(as  stated)  that  generate  steady  state  gain  values  (K  matrix).  The 
second  time,  using  these  steady  state  gains  to  compute  the  estimated 
state  along  the  entire  TAFP.  This  suljstitution  considerably  reduces 
total  computer  time  and  costs.  This  is  accomplished  because  the  entire 
filtering  routine  is  replaced  by  the  following  statements  in  the  main 
program. 

GAM,  MPRl)  (K,  H,  KH , L,  3,  L) 

CALI.  MPRD  (FH,  XH , FHX,  L,  L,  1) 

DO  100  I = 1,  1. 

DO  100  J = 1,1. 

IFd.LQ.J)  GO  TO  93 
KH(I,J)  ' -KIKI.J) 
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GO  TO  100 
95  CONTINUK 

CALL  MI’RI)  (K,  Z,  KZ , L,  3,  1) 

CALL  Ml’RD  (Kll,  FIIX,  KHFHX,  L,  L,  1) 

DO  110  1 = 1 , L 
1 10  XH(I  ) = KtlFIWd)  + KZ(I) 

These  statements  are  positioned  in  the  main  program  in  place  of  Call 
FILTER.  The  variable  designation  and  dimension  have  to  be  modified  to  insure 
a legal  substitution  in  the  main  program, 

IMFLlCiT  REAL  (K) 

DIMENSION  KH  (9,9),  F11X(9),  KZ(3),  KHFHX (9) 

L = 9 

The  steady  state  rate  aided  filter  is  similar  to  the  one  necessary  to  ob- 
tain the  position  only  steady  state  filter.  The  procedure  described  above 
carries  over  to  this  case  except  that  all  numerical  threes  appearing  in  the 
proceeding  program  statements  are  to  be  replaced  with  numerical  sixes. 


Combined  Algorithms 

All  possible  combinations  of  filter  and  sensor  algorithms  have  not  been 
presented  in  this  report.  For  example,  the  user  might  wish  to  observe  the 
effect  of  correlated  noise  in  a steady  state  rate  filter.  This  may  be  accom- 
plished with  minimum  alteration  to  the  major  components  of  the  program  because 
of  its  modular  design.  However,  the  user  must  be  very  careful  when  imple- 
menting changes,  especially  in  the  alteration  of  the  dimension  or  complete 
removal  of  program  variables. 
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INDKX  TO  ROUTINES 


This  index  provides  the  following  information  for  the  main  program  and 
the  subroutines  where  applicable. 

1)  Alphabetic  indicators  that  appear  in  subroutine  flow  charts 

2)  Name  of  routine 

3)  Page  number  in  this  appendix  where  routine  description  appears 

4)  Computer  memory  storage  requirement  represented  in  decimal  words 

5)  Argument  list  - calling  and  returning 

a.  specific  list  - these  routines  were  written  for  the  listed 
variables 

b.  general  list  - these  routines  were  written  for  any  suitable 
variables 
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Letter  Name  of  Routine  Page  Memory  Calling  Variables  Returning  Variables 


F 


u 

H 

-I 

H 

H 

• 

* 

Q 

•n 

Q 

X 

:e: 

u 

•> 

• 

M4 

a.  U4 

1) 

05 

<u 

05 

05 

X 

• 

cx  y 

< 

o>  S 

e 

I S 1 

1 B 

1 

05  S 

u 

1 ^ 

1 CD 

1 

• 

• 

X H 

to 

to 

to 

CO 

to 

75 

• 

X H 

c 

15  Q 

< 

05  Q 

05 

05 

PQ 

CQ 

6 

S 

flj 

Co 

LO 

to 

< 

< 

0 

CA 

X 

UJ 

u 

> 

c ^ 

X 

0 

CTJ 

t—4 

iM 

fM 

H 

0 

0 

Cm 

c 

• 

0 

c 

e 

>% 

No 

, 

•H 

to 

UJ 

CO 

0 

tn  *-H 

7: 

Ou 

u 

X 

*H  0 

p. 

u 

0) 

0 u 

3: 

X 

C 

5 

•» 

u 

lu 

X 

0 

CN 

Cm 

O' 

t— 1 

•* 

X 

X 

>M  0 

X 

y 

M 

X 

0 

X 

» 

2 

•> 

CO 

vm 

•1C 

• 

X 

•—( 

05 

UJ 

05 

05 

U 

0 

H 

• 0 

a. 

H 

> 

X 

> 

> 

Q 

•-H 

0 X 

» 

X 

Q 

0 

M 

0 

Q 

0 

< 

• 

•• 

X 

re 

0 

H 

pQ 

X 

X 

0 

X 

» 

0 

!-♦ 

-< 

C 

UJ 

< 

X 

• 

•* 

• NJ 

X 

»— < 

X 

X 

0 

rj 

CN 

X 

Q 

ts) 

•* 

tf) 

(55 

»> 

CO 

•> 

X 

C 

U4 

*• 

NJ 

H3 

Ou 

OJ 

H 

nj 

X 

X 

X 

•H 

(X 

0 

*> 

•* 

Q 

iJ 

X 

X 

•> 

X 

05 

X 

05 

• 

05 

00 

•> 

•K 

f-i  CA 

X 

X 

X 

8 

X 

8 

Q 

E 

c 

X 

•K 

« 

p- 

nj 

p> 

nj 

»> 

05 

»~4 

G 0 

X 

r»J 

NJ 

X 

to 

X 

to 

X 

CO 

X 

2 

X 

•M 

o 

oj 

•-H 

► o 
u 
X 


d>  o 
05  7; 
o 

Cl  - 

0)  «— t 

c 


ir» 

m 


00  f“H  i-H 

<N|  .-H  vO 

(T*  C4 


m m -H 
I O m 
I ^ 04 


.-H 

ON 


O' 


(N 

e 1 

f’') 

J 

Lf\ 

vu 

h 

03 

CJ 

• i 

rvj 

on 

C'^5 

.-t 

J 

- 1 

.-H 

»-^ 

f 1 

r ^ 

r-l 

rH 

(M 

^VJ 

CM 

CM 

OVJ 

tM 

CM 

C\J 

r < 

r 1 

rH 

r~i 

.-H 

r*J 

f-i 

. ^ 

r < 

rH 

<H 

rH 

rH 

.-J 

'll 

X 

X 

u 

X 

H 

rJ 

H 

M 

0 

UJ 

UJ 

HH 

rj 

•K 

h- 

X 

H 

to 

H 

J 

H 

X 

El 

Q 

0 

°3  9 

UJ 

NJ 

t-i 

X 

rJ 

0 

H 

H 

X 

2 

X 

X 

X 

PS 

> 

>• 

X 

UJ 

M 

0 

r-I 

X 

U 

0 

X 

H X 

H 

X 

X 

Ml 

to 

X 

0 

X 

0 

< 

0 

u 

X 

NJ 

to  2 

X 

»M 

I 

I < 


CQ  CJ 


Q Q W 


O C.J) 


132 


rows  in 


Name  of  Routine  Page  Memory  Calling  Variables  Returning  Variables 
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COMPUTER  PROGRAM  LISTING 
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I I N ION  I ( oi  . ai  • k.A  • n • H » u 'i  I *0  I 1 . n 

f'ATa  AH«  , Aht  . Am/ / 1«  , I / 

r f;Pf  i |P  V S'.M  .f  u /,»  ,Tan  S Tf)  Of  f ST  P<AT»  O I S 

< SPirift  »l.r  fOP  (OMPiiTfl.  S|MniAffO  FlI^mI  i ATm  OaIA 

I < S4  r tj  ipppi , I I » 

f c p(  ^ I r r f ( r : >•<  * OP  AC  THAI  FI  I f.MT  PATH  OAT  A ( *.I  f SuPPOOT  Isf  AC  TUM  4 

* I T s wO  AF  f PA  I A 

f L r • T*< 3ws 
■ P.M  "OP. 
p‘-lsr  lOOT 

j A«  A f ripu  A r ( ) *4 1 I 

p » r i.  T ,sf  , OMi-*P  '■All  ar  To  Ai  ( « •r»,o  T **ir  I 
P (»  c r 04  '•s  I rail  Oyn  1 1 ,r. . nt  ,sr  nm 

f'«-^,**AHjr#  I , 

»-Tr?,*AHy<»S|r. 

r f N M A.  T '4  •>  A\  • '•«  SOMMf  u r.FOf  >.  A T >P 


ran 

*4as'-  n ^ \ r \ •> , 

C f 

' /r  * 

r Ai  1 

/f  p n 1 ► « 1 • ‘I 

r Ai  1 

' f I-  0 f i*  1 . T » 

"AI  1 

M fc  “U  f.M  , 1 1 

r At  1 

'•  POfP.i  .1  I 

'All. 

,l  » 

(All 

/ F p n 1 M , 1 , 1 » 

" Ai  -^A'l  f IL  rr  --  I ANT  wrroF  l 
fNfTAtl/4  ri‘Avr|TlON  MATPIi--fo 


( Mp  t «C 

■ 9 1 • A 04  1 > ( 1 > 

» MP  y •( 

I D 1 - A.^»  •(*!  1 

‘ •^O/.f 

tP  I -A-4/*|.1  » 

1 M A I » ( 

1 . - 1 1 -tf  < 1 / A wi 

( M A V • ( 

1 , • T F wi(  y > / Amt 

4 ^ A / ■ t 

1 , - I*  X*  / 1 /.H/ 

- M . 1 > 

* 1 . 

* \ • 

.<  ( 1 . X 1 

* \ . 

^ f 4.  t 1 

^ 1 * 

13'* 


t »«  I ^ ) c I . 

» < f , n » T > 

» »-  t I • 4 » t '>  r 

>►*<<»•  ')»Tr*^A« 

f = J . 

f »M  M • >«  » r r f *^0  > 
f ►*  I ^ 4 *'  > T T 

»M|^,.i|2nT-Tf'^4TWA*^v 
f H ( O , 'M  * T ^ «P/ 
f‘-(>,'Mr(nt-T^«fl/l  / A»V 

‘ Mc.l  L vA  T fON  M^TiM*--  *' 

M . J » * J , 

H • > 4 ^ I » 1 , 

Mi  1.11^1. 

l*ylTA^|/»  »rlTAt*0>4  “ATUlii--  ^M 

'•Mi|,^»r|fT*nT/;>,-f'T/AH**TrHA>/flH#i/AH* 

c»M  *?,^»sut*nw?,-nT/AHt*Tr*^AT  / > / amy 

(.M(1,U*(l'T«n?/?,-f>1/AH/*TrMA//6M7»/AM/ 
i.Mi<,4  y ) r it>i  - Ti  ‘^a«  I / AHi 
(pl-T>  MAf  I / Ahv 
l»r  iMT-T^MA/>/AM7 
I N 1 ) * T ( MA  1 
rf».wAv 
r,M  < a , 1 > « Tf  mA/ 

C INITALI7K  «.TAT^  PAfjOOMNf  SS  CnvAU(A*jrr  matpIi  --0 

0 ( ! 4 P 5R«  /^.  T 
Qi  ?,?t  xHy/r,T 
fH  ' 4 1 » e o 7 / (1  T 

C I»^!TalI7F  sTAfr  vFrtOP--  xh  A^(^  fppop  rovAP|ASrr  ma^pI*«-  p 

ra^L  APT  < 7 4 » • *H*p  *p  *rT » 

P ( 7 * 7 i -S  f 1 

P i u , O » rt,  J 

p i < , O j 2 1. 1 r. 

C INtTALl/^  t.ai»i«ATui*--.n 

- P 4 n ? 

^ i 7 4 ? I = , 

« ( U U S,s 

r»0  f nPMAT  f'M  1 ■ ,m/.^-4  I * M 
I -'O  f f>pMA  T 11(^1. 

P*-rNT  SOO 

f OpMA  T ( // / 4 • • 1 

pFfNT  AOO  • AHjr  4 Any  4 Am7  4 S 1 0 

400  FOPmAT  tlS»*THp  A <>  STATF  xA^man  FIl'^Fo  S1«“lAT1on  -Ati  vAr|aH( 
)PS  APF  IS  US  ns*  4 // 4 / • I 0*  4 •'■'MF  F,A  I s • 4"^  ^ 4 1 4^  » 4 *r>Mf  f,A  V r •, 

If  ^,T4SX  4*^mF  r,A  7 S •4rA,.1,Mi,**SK-^A  r •.Fb,7,//» 

POINT  lOS 

r OPmaT  1/ 4 I 0*  4 • TP  AVS  P ION  maTPI*--  f •» 

PPINT  ?00  4»  M 
PP|ST  10« 

IP-*  rnpMAT  I /4  I OX  4 *F  *r  M A T ION  maTPI*  — Gh*  1 
POINT  ?004f.M 
POINT  10*4 

io«4  ropMA  T ( / 4 1 OX  4 *F  ST  iMATrn  statf  vrrTOP-*xu») 

POINT  IOO4XH 
point  10ft 

10^  f OPMAT  ( /4 1 Ox  **ST aTF  f poop  fOVAPlANCf  maTPIX--  P»> 
point  ?004p 

PPpjT  10^ 

loT  rnwMA  T < / 4 1 OK  4*ga  in  matp|x--  »r*» 

POINT  1004f 
Of  Tt)PN 

rx^ri 
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kuf-ooiii  I sr  AH  < ' . 1 • IMF  » 

OjMFNsION 

(>lMrq*  jnq  0<  . i <0» 

r)ATA  M/t/.I?/*./ 

Pt^lNT  100^ 

|OO0  » OU'iA  T < / . I 0 * • • 1 N I M At.  SrN*;rtO  Mf  ASlIor  Mf  STS*  • ^S*  • *V  AO  I A^.rF  ^ 0^  Th>S» 
] ASHJF  Ml  sT  S*  . / » 

MI  M ssot  MiAS''orMfsT  **ir>  loono  rovAoisff  stoua'.f 


•IM  I ft 

1 

» 

1 1 

. )? 

r Ai  L 

SI 

s 

sop  f f 

• ■ 

V ( 1 • 

1 • 

• P 

1 1 * 

1 » 

Vf^. 

?• 

• P 

*?* 

^ I 

V t n 

X, 

• u 

( 

^ 1 

V M . 

p. 

mtJ 

< 1 . 

^ 1 

V M . 

^ • 

• P 

1 1 • 

1 1 

V tP. 

• P 

«?. 

y\ 

VI? 

, 1 

• 

1 

I xp  M 

. ? 

V M , 

1 • 

( 1 • 

« 1 

V 1 * « 

> , 

■ 

1 1 

/V  ( 1 

. 1 

t 

f f 

1 1 

/V  ( 7 

• I 

= 

/ ( 

,7| 

/V  1 1 

• 1 

t 

; « 

' 1 

.'or  A I '.UM4  T I> 

nil  **  L OAT  f I?- 1 I » •!»!  I*^r 
f>T  ?:D\f  •nil 

INITIAI  1/f  r<.T|M*Trn  «'TATF  virTOP--  IM 
nr  yfi  i * j • 

■ »-fi>«;vii*i?» 

■ Mil,  Ur(/v(i.i?i-;vM.I!>t/nii 

I tsMUir/f  *stimaThi  stiTf  fppno  rnv^wiAsri  uahmh--  p 

M I I • 1 1 »v  T : . I . i ?» 

10  P(i*i.i,  n = (vi|,i*i?T*V(|«f.in)/nt;i 

p I . n = V I I . u I .*  I 
P I ^ . T » s V t ^ . T . I •*  > 

p I ? . I I •?»'  I I • ? » 

M I u n siM  I • u 

K U ?»  T|M  M 

f)H  <*0  I * I • T 

i»n  *, 0 I I • T 

! I t ! r , n i.n  Tn  , ^ 

*,0  rusf  isuf 
Of  TUPS 
r nn 

MiPU0"TIS«  l]tTIP»/*W,  ')• 

I I r n PI  AL  I ► » 

fiiMMOS  /li**/  i 

I |(IS  ■ ( ni  , XH  ('M  ,M  ( 3,0|  (Q,  II  ,H  (Q,  II  ,P  T ( , 7 f IT 

I .iM{-4,v^i,iHr(Q,Qi«piQ«qi.i:,HiQ«3)tnTM«)i«r>c(q«gi«o«3«3i<0(3«'n 
. mp  I q • Q I *F  t mP  I *ni  hT  r<»,o  I .r,M()  iP,  ^l•,rp|s•^l,rH^O(q•l» 

^ ««0)«PHT<q,3i»MPMTn.1|«OPf3.M*(?PTM,l| 

I,  •lMl|0|,pi/tqi,^HlHliq)«AHm,0| 

f .ifMn*’  roMPi.iAT  im  OF  fSTiMAUn  staT(  fopop  tOvaoiascf  matp|b.-  p 

TAI  L I 

fw  * fi  I » I .L 

on  t e U I ,1 
M M ,i  n,.M  ftO  in  F.O 
■ M 1 1 , n < - ^ H ( I • j I 
nn  TO  so 

* 0 * I I . M s ! , ->■  H ( I , M 

r n r(  kjl  |.j,,F 

r At.1  MTPA  («  .t  ,l  I 

TAH  **Ppq  I*  H.P  ,»  HP  ,L  *l  *L  » 
fAi.1  MOPn  1 1 H , ► mP  «•  K nP  ,L  *1  *l  I 
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fAM  «l  » 

f At  1 ( I • MT  ,1  ,(  •!  » 

r All  MyUfli  pui  ,»  Ml  ,«*  ,L  ,l  ,(  » 

r A|  I ‘-T^'A  ,l  . It 

r Al  I '-PfcjH  r.M.O  . 1, 

CALL  MPfO  M.Hf}.  f.T  0*1  » 

rAi^l  uTOA(n»i^r,t*^t 

f Al  L “OR()<^  . p,l.  • I*  H 

(AIL  *^oR0  ( t H ,»i  u J ,i  ,i  , w 

TAIL  “RPOUH^P.^T.K^-fTa.l.Lt 
CALL  “OPfl  (t-P^T.tHr#"*iT.l.(  *i  t 
ni-*  PO  I*  I ,i 

Of'  «<>  Jt  \ ,i 

r ( I , n *»•  H I I , )>  •r.f,  ( 1 , )t  •i'*'  7 ( 1 • i > 

' t N >«.  f *^p|  »T  A r I or  p.MArPfi 

( ‘*f  .INs  rr  mP,,T  A T n**i  OF  (.AIN  MATiMi--  •> 

( Al  L “|PA  (m.mT,  |«|  » 
rA(l  MOUf>(P,MT,PHr*L*l* 
f AIL  »^PPO(M,p.  T.HPHTf*t,L«  t) 

1»0  wo  I = I • 7 

nc  NO  1=  1 1 7 

.0  I I • I I = Hi  MT  ( I • j » • P I I • J > 
r Al  I I .JVF  M |R<  .PP  I t 
(A(L  ‘^PPO(PHl*WP|*»r*l,'^,\» 

( (O-MuTAlIftN  ()F  N-«ATB|« 

C »INs  (Ompmtation  nr  istipaifo  staic  vF(T"p--  «“ 

f ALt  "PWrUK  , 1,L  I 

C ALl  “PRO  (F  H,  «»  •»  H«  ,L  •(  . I t 

no  ion  I •! ,L 

no  100  J"  1 *i 

IF  M .FQ.  M GO  10  R*; 

«M(  I • II  =-KM|  I , Jl 
GO  TO  100 

l<M(  I , Jl  r 1 ,-XM(  I • JV 
irr»  rOMlNuF 

j c Al  L MDPO  (f  •/  •»■  /*L  • 1.  1 1 

( CALL  ^PPO  f "M,f  MX  ,nHrM*  ,t  ,L  . I I 

on  11 C I-I ,L 

1)0  IH|  I ) .KHrM*  { I ) ( I I 

r fnds  c<"mpijtat  ion  or  xh-vtctop 

PF  TUPN 
FNP 

SOPPOl.T  INF  SFN«'OP  ( ; • * •P,r>I 
(Vjmmon  /^hO/  f L T 

nlPFNS  If»N  * 1 01  .0  ( J 1 • / ( 'll  . J N I 1)  *p  n.  1 1 

r ‘-FNM^O  ACrtlPAC  IF  S I V AP  I ANTf  S» 

DATA  S If  P.S IGIH,SIGPM/ I 00* .?• I f-0^/ 

call  pANon*»Fii 

C lOGlClAL  OFflSION  A<;  TO  «mICm  mFTHOO  OF  TAPGFT  AtPfPAFT 

r FI  IGmT  PaTm  (•FHr»^ATlON  IS  TO  PF  IMPI  lOfFlTFO 

r Sf  F SUPPOdTINF  FOP  (tFTAIl*; 

iF(FiT,fo,  I cAu  COMP  I « *n#nr  *NrF<n» 

IF  <Fl  T ^ TALI  DATAlx.OfOT.NFNOI 

r GfNFPAMON  OF  SFNSFO  VAIIlfS 

0<,sr)  < I ) • XN  I I I • SOP  I <SIGP» 

THSN*rUi.»  "SOPT  ISIOThi 

pMSNeO I r » ♦ AN  O » «SOPT  < S I GPH | 

THS*SlN(TMSNt 
THC*COSlT»-SNt 
PPS*SlN(PNSNt 
PHCsfOS  (OhSM 

c roMptjTF  SfNSFO  STATF  VFCT0P--  / 

r NOTF--  IF  nSFP  PPOVinrs  hIS  OuN  r0(^OnlNATF  sft 

r *,  TMFN  TMF  FOIL  Owing  TOAF^SFOPMAT  IOMS  A»uST  also  tF 

( MOOIFIFO 

/ n t »-ps*phc*tms 
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/ ( ? > • IMC 

7(11 «PS»PhS 

C CO“Pl)TF  C0V4P|*NCf  or  SFUSFO  ST*Tf  M»TPIK--  P 

P7iPS*PS 
TS?»Tms«Im«; 

Tr?»TMC»TMC 
P<,?»Pms«PmS 
pr ?»PHC*PHr 

0(  I . 1 I wP?*  (<iIf,PH»PS?»TS?»Sir,TM»Sir,PM»PS?»TC?»Slr.TM»OC?»TC?> 
1 .<;ir,p»Pc?»T<;? 

«(?.?)  »P?o  (Sir.PH«PS2»TC?»Sir,TM»SI&PH«PS?»TS?»Sir,TM»oc?»TS?l 
1 .<;ifP«PC7»tC7 

p(  1,11  •p?*sir<pH*pr?*str>R*Ps? 

p ( 1 t ?)  *P?»TS?»TC?«  (Slr,PH»P<;?-<;Ir,TM»pC?l  -«;ir.R»PC?»TMr»TMS 
p ( 1 . 1) «-  (sir.p-p?««iioPHi  pphs^pmCpths 
p (?.  11  • (SlGP-i>?»SlOPH»»PM$«PMC»THC 
P (7. 1 1 *P ( 1 .?! 

P( 1. 1 1 *R( 1 . 11 
P ( 1.71 *p (7. 11 
Pf  TllPN 

run 

SIIBOOIIT  I*4F  4CTII4L  « » «0,riT  ,NFNni 

OIMFNSIO*!  »iQl.n(Pl 

I.  PG ( 11 • Th ( 11 ,PH( 11 
PFKiNn  B 
PEAOfStlOl  COM 
I 0 ^ OPMAT  (41 1 

Pf4n(S,?0l  NlIMPfO 
?0  FOPM4T ( IPl 

C SPFCIFy  LFNGTH(NFN01  4Hn  time  increment <0TI  or  T4PGFT 

c flight  P4Tm  GFNFP4TION 

NFNn»NUMBFB-S 
0T  = .I 

m 7 = OT»OT/7. 

r INPUT  » POM  I4Pf  INITI41  TPUF  ST4TF  CONOITIONS 

Pf  40 (S. 10 1 ( « ( I 1 , I«1 .PI 

PF  TllPN 
FNIPr  D4T4 

C TPuNC4rI0N  OF  sFPlrs  F»P4N«,I0N  to  obtain  position. 

C velocity  from  4CCFLrP4T|ON  04TA 

« ( 1 1 r « ( 1 I . « ( (,  I «0T  • « ( T 1 VOT? 

« ( 7 I . » (7  I . « (SI »nT . » («I«0I7 
Till. 1(11. «(M«nT««(0|4fiT7 
«(<.l5>(i.l.i(71*0T 
«IS1=«ISI««(RI»0T 
«(f^lca(t^l•>(91■nT 

^ INP'IT  FROM  T4PF  4Cf  f Lf  M4T  ION  04T4 

PF4O(S.',0l  «(71.«(«1.»(P1 

call  P4NGF  ( « .pc.  1 
C»LL  Thft  («.Th1 
call  phi i ■ ,PH1 
D l I 1 **0 l I 1 
0(71 »PG l 7 l 
0(11 aPOl 11 
0(<.  1 »TH(  1 I 
I)  ( S I « Th  ( 7 I 
1)  (M  I TM  ( 1 1 
0(71 »PH( 1 1 
0 I « I «?H ( 71 
0 ( q 1 sPh ( 1 1 

in  format  ( I 0« • IF  10.  1. OF  I 0.4  I 
fcO  F0PM4I ( 70« . IF lO.Ml 
PF  TURN 
FNO 

SliMBOilT  INC  OUTPT  ( < .Xh.p.k  , T IMF  • I I I 

PF  4(  " 
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fO«Mr>»j  /Li«/  I 

COMMON  /l«»LFS/  L .L  *«m,l  4PS 

nlMCNSION 
DO  10  I » 1 . 1 
1ft 

PBINT  100ft. II. FIMf 

iftoft  ropM* r (/,  1 o« . •N()Mnr»  of  itf»»tidns  used  im  filtep  * '.is. 

1 S«  ,*COPPFSPOMnINf.  TiMf  « •.FlO.?.//» 

LftPS'lOM  staffs 
LA8T«10mTPUE 
LARE*10mEST1MaTFD 
LARMilOH  - MINUS  - 
PPfNT  ?oon.LART.LA«S 
?ftnft  format US».SAlftt 
PRINT  T000.« 

10 Oft  format ( |«« .*P0SI T ion*. ISF. |S> .•VFLOCITr*. is*. IS*.*ArCFLfR*T ION*./. 

? P( 1 «.El?.h.?«  > .//) 

print  i»000. lark  .cars 

PRINT  lOOO.AM 

PRINT  ?OOft.LART.LAB5.LARM,i  ARF  .LARS 
PRINT  JOOO.XXM 
PRINT  SOOft.P 

AOOO  FORMAT (/. 1 ft  * ,*STATF  frboR  OOvaRIANCF  MATRIX  — P»./. 

1 R (O  ( 1 * ,F  1 I ./I  I 

PRINT  snon.F 

SftftO  format (/. 1 0» .‘OA IN  MATRIX 
I 3(R(I*.fl?.F,.?X>./lt 
RETURN 
END 

SURROUT INF  rOLLFCTlX.XM./.II.DTIMF.Nt 
COMMON  /LARLFS/  I ART.LABF.LARM.LARS 

dimension  DXP(F.ft0>.0*V(Fi00l.nxA((>00).Dro(Fv00I.  DTV(A8«),OyA(600t. 
ID/P  1600 I.O/V(6ftft>.D/*<6C0l .n*s  <6001 .OrS (600 » .D/s (6ft ■ > 

DIMENSION  *(q).XM(Q).7(J».Sir.(I?I 

r IF  plots  of  truf  and  estimated  states  are  oesipeo  then  the 

r USER  SHOULD  STORE  ALL  OFSIRFD  OAT*  IN  THIS  ROUTINE  .FDR 

c example  xtplot ( I n »* t n .xeplot ( 1 1 )»xhi i » . etc... 

C STORES  truf -ESI IMATFO  STATES  AND  TPUF-SENSEO  STATES 

1)IP(  I H .*  ( 1 I *XH(  I 1 

OrP( II)«*(?»-XH(?» 

0/P(II>**(3t-*Mni 
DXV(  I n*X  (A).*M(AI 
OTV (III**(SI-X”(St 
0/V( II)** (h)-XH(ftl 
OXA(II)»*(7l**H(7l 
DYA ( I n t * ( H I -*M (R I 
D/A ( I I ) **  (9) -*M( P) 

OXS ( I I) •* ( I ) -/  I I ) 

DYS ( I I )**(?)-/ (?) 

D/S  ( 1 1)  *x  (3)  -/  n> 

RETURN 

entry  plot  inf, 

C COMPUTES  MEAN  SQUARE  STATISTIC  EoR  A|.L  OIEFERENCFS 

call  STATl  (OXP.N.SIGd  ) ) 

CALL  STAT I <OYP.N.SIG(?) 1 
CALL  STATI  (O/P.N.SIGO)  ) 
call  STATI (OXV.N.SIG(A) ) 
call  STATI  (OYV.N.SIGISM 
call  STATI I0/V.N.SIG(6M 
call  STATI (OX*. N.SIGIT)) 

CALL  STATI (OYA.N.SIGTRI I 
CALL  STATI ID/A. N.SIG(9) ) 

CALL  STATI (DXS.N.SIG(IO) • 
call  STATI  (DYS. N.SIGdl  H 
call  STaT)  (0/S.N.S!Gd?M 


139 


Pk-  I*|I  1 000 .1,  *MT  ,L  »«s*l  fl  »H«. 

inno  f0P“*T  (//■/, ??»,»Mr»N  souaufo  fhpoo ‘.SolO./zt 

PPIN1  3000,  tSir.t  1 1 = 1 .•»> 

30n0  F0PM*1 ( /,P ( 1 « ,F 1 » ./ I 
l.*H<;S*10HSfNSOP  ST, 

PPIMT  10no,i4«T,L*PS,L»"M,L  *HSS,L  4*S 

ppixT  3000,si(. ( io«  ,slr. ( 11 ) ,sir. • !,>» 

»f  TilP*i 


C 


r 

r 


( 


C 

C 


r 


rNo 

SUUQOUT  Wf  OWNM  ,n*OT 

COMMON  /L?“/  L 

oIi^rNSlON  ■ ( Pt  ,r  (g*g»  ,r,  j g,  *!»  • » *0 ( i>  • w M » ,r i (p>  (qi 

1 • or.  ( > ) , Th  ( 3 t l t'MQ) 

rOMSTANTS  Ai.Af.A/ 

OATA  AIoAVoA/Z^*,^!/ 

srr,=  ionn. 

ir, 

HVs7,»AV*Mrt 

H/  = ?.*A/»Sir, 
rAU  /FOO(f*L*M 
fail 

r Ai  L /f  MOiO,  3,  u 

*;p»rif^r  I F»if,TH(NF  Nni  AND  Tl*^F  I NCPF^rNT  < OT  » OF  TaPOFT 
ILH>wT  PATH  GfNfP^llON 

IM  T . I 

SF  ^r*-  4^^ 

INITAl  <,TATF  VFTTDP  --X 

X ( 1 ) X 

* ( 7)  r-  3*'S  4.  3 I 

■ ( 3J  r M 
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Commander 

US  Army  Materiel  Development  and 
Readiness  Command 
5001  Elsenhower  Avenue 
Alexandria,  VA  22333 


1 Attn: 

DRCDE-R 

1 Attn: 

DRCDF.-W 

Commander 

I'S  Army  Armament  Command 
Rock  Island,  IT.  61201 

1 Attn: 

AMSAR-SA 

1 Attn: 

AMSAR-RDT-S 

1 Attn: 

AMSAR-RDO 

1 Attn: 

AMSAR-RD, 

Mr.  Brinkman 

1 Attn: 

DRCPM-ARGADS , 
Col.  R.  Parker 

Commander 
Picatinnv  Arsenal 
Attn;  SARPA-AD-C 
Dover,  NY  07801 

Commander 

Rock  Island  Arsenal 
Atm:  SARRT-I.,  Dr.  Beckett 

Rock  Island,  II.  f.1201 

Office,  Secret arv  of  Defense 
The  Pentagon 

Attn:  DDR&E,  Mr.  T.  Kotanias 

Washington,  DC  20310 

Commander 

US  Army  Training  & Doctrine  Command 

Attn:  ATCD-CF-A 

Ft.  Monroe,  VA  23651 


Department  of  the  Army 
Office,  Chief  of  Research  and 
Development 
Washington,  DC  20310 


1 Attn: 

DARD-DDZ-C, 

Dr.  V.  Garber 

1 Attn: 

DARD, 

Dr.  M.  Lasser 

1 Attn: 

DARD-DDM-A 

Office, 

Deputy  Under  Secretary 

of  the  Army  (OR) 

The  Pentagon 
Washington,  DC  20310 

1 Attn:  Dr.  W.  Payne 

1 Attn;  Dr.  D.  Willard 

Commander 

US  Army  Air  Defense  School 
Ft . B1 i ss , 

1 Attn:  ATSA-CD 

1 Attn:  ATSA-CD-MS, 

MAT  Emmeret 

1 Attn:  ATSA-CTD-MT-T 

Commander 

I'S  Army  Armor  School 
Attn:  .ATSB-Cn-CA 

Ft.  Knox,  KY  40121 

D i rec  t or 

US  Army  TRADOC  Sys  Anal  Act 

Attn:  SARWV-RDD 

White  Sands  Msl  Rg,  NM  88002 

Commander 
Watervliet  Arsenal 
Attn:  SARWV’-RDD 

Watervliet,  NY  12189 


DISTRIRDTION  (Cont) 


Projc<-t  Manager 

Mechanized  Infantry  Comhat  Vehicle 
System 

28150  Oeqiilndre  Street 
Warren  Ml  48090 

D1  rector 

Army  Material  System  Analysis 
Agency 

Attn:  AMXSY-1),  Dr.  .1.  Sperrazo 

Aberdeen  Proving  Oronnd,  MD  21005 

Defense  Advanced  Research  Projects 
Agency 

1400  Wilson  Boulevard 
Attn:  Dr.  F, . Oerry 

Arlington,  VA  22209 

Defense  Documentation  Center  (12) 
Cameron  Station 
Alexandria,  V'A  22'il4 

Commander 
Fr.inkford  Arsenal 
Philadelphia,  PA  19137 

1 Attn:  AOA-M 

1 Attn:  TD 

1 Attn:  PA 

1 Attn:  CC 

1 Attn:  FSC 

1 Attn:  KCD 

10  Attn:  FCW-D, 

Mr.  Walter  Dziwak 

1 Attn:  MCD-A 

3 Attn:  TSP-h/51-2 

1 - Circulation  Copy 
1 - Reference  Copy 
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